JP5043760B2 - Vehicle obstacle avoidance support apparatus and vehicle obstacle avoidance support method - Google Patents
Vehicle obstacle avoidance support apparatus and vehicle obstacle avoidance support method Download PDFInfo
- Publication number
- JP5043760B2 JP5043760B2 JP2008157310A JP2008157310A JP5043760B2 JP 5043760 B2 JP5043760 B2 JP 5043760B2 JP 2008157310 A JP2008157310 A JP 2008157310A JP 2008157310 A JP2008157310 A JP 2008157310A JP 5043760 B2 JP5043760 B2 JP 5043760B2
- Authority
- JP
- Japan
- Prior art keywords
- avoidance
- vehicle
- avoidable
- obstacle
- 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
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
- Steering Controls (AREA)
Description
本発明は、運転者による障害物の回避操作を支援する車両用障害物回避支援技術に関する。 The present invention relates to a vehicle obstacle avoidance support technology that supports an obstacle avoidance operation by a driver.
運転者による障害物回避操作を支援する技術としては、例えば特許文献1に記載の技術がある。この特許文献1に記載の技術は、次のようなものである。
操舵によって障害物との衝突が回避出来る最小の回避距離を、操舵回避距離とする。また、制動によって障害物との衝突が回避出来る最小の回避距離を、介入制動回避距離とする。そして、操舵回避距離が介入制動回避距離未満である条件を満足すると、次のように制御を行う。すなわち、警報後に運転者による操舵操作が行われない場合には、障害物との距離が介入制動回避距離を下回った時点で制動介入制御を開始する。また、警報後に運転者による操舵操作が行われた場合には、障害物との距離が介入制動回避距離を下回っても制動介入制御を開始せず、障害物との距離が操舵回避距離を下回った時点で制動介入制御を開始する。
As a technique for supporting the obstacle avoidance operation by the driver, there is a technique described in
The minimum avoidance distance that can avoid a collision with an obstacle by steering is defined as a steering avoidance distance. Further, the minimum avoidance distance at which a collision with an obstacle can be avoided by braking is defined as an intervention braking avoidance distance. When the condition that the steering avoidance distance is less than the intervention braking avoidance distance is satisfied, the control is performed as follows. That is, when the driver does not perform the steering operation after the warning, the braking intervention control is started when the distance to the obstacle is less than the intervention braking avoidance distance. In addition, if the driver performs a steering operation after an alarm, braking intervention control will not start even if the distance to the obstacle falls below the intervention braking avoidance distance, and the distance to the obstacle falls below the steering avoidance distance. The braking intervention control is started at that time.
すなわち、障害物までの距離が介入制動回避距離を下回った場合に、運転者の操舵操作を検出しており、且つ障害物までの距離が操舵回避距離以上であれば、制動介入制御を実行しない。一方、障害物までの距離が介入制動回避距離を下回った場合に、運転者の操舵操作を検出していないか、障害物までの距離が操舵回避距離未満であれば、制動介入制御を実行する。
上記特許文献1では、障害物までの距離に基づいて回避可能性の判定、つまり回避操作支援の必要性の判定を行っている。
ここで、追突事故やそれに類似した場面において、車両の運動状態が直進状態にある場合には、障害物との距離は、回避可能性を判定する良い指標となる。しかし、横から障害物が飛び出してくる場面や、車両が旋回運動を始めて直進状態でなくなっている場合では、車両の姿勢やヨーレートなど様々な車両運動状態が回避の成否に影響してくる。このため、障害物との距離だけに基づいて回避操作支援の必要性の判定を実行すると、当該判定を精度良く行うことが出来ない場合がある。
本発明は、上記のような点に着目してなされたもので、回避操作支援の必要性の判定を精度良く実行可能として、運転者による障害物回避操作をより適切に支援できるようにすることを課題としている。
In
Here, in a rear-end collision or similar scene, when the vehicle is moving straight, the distance from the obstacle is a good index for determining avoidance. However, in the case where an obstacle pops out from the side or when the vehicle starts turning motion and is not in a straight traveling state, various vehicle motion states such as the vehicle posture and yaw rate affect the success or failure of avoidance. For this reason, if the determination of the necessity of the avoidance operation support is executed based only on the distance to the obstacle, the determination may not be performed with high accuracy.
The present invention has been made by paying attention to the above points, and enables the determination of the necessity of avoidance operation support with high accuracy so that the driver can more appropriately support the obstacle avoidance operation. Is an issue.
上記課題を解決するために、本発明は、自車両が所定時間後までの間に障害物と接触することなく走行可能な自車両状態の範囲を回避可能集合として算出する。そして、現在の自車両状態と回避可能集合の境界との関係に基づいて、回避操作支援の必要性の有無の判定を行う。回避操作支援の必要性がある場合には、運転者の回避操作を支援する。 In order to solve the above problem, the present invention calculates the range of the host vehicle state in which the host vehicle can travel without contacting an obstacle until a predetermined time later as an avoidable set. Then, based on the relationship between the current host vehicle state and the boundary of the avoidable set, it is determined whether or not there is a need for avoidance operation support. When there is a need for avoidance operation support, the driver's avoidance operation is supported.
本発明によれば、障害物との距離だけに基づいて回避可能性の判定をする場合と比較して、回避操作支援の必要性の判定を精度良く実行可能となる。この結果、運転者による障害物回避操作をより適切に支援できることようになる。 According to the present invention, it is possible to perform the determination of the necessity of the avoidance operation support with higher accuracy than in the case of determining the avoidability based only on the distance from the obstacle. As a result, the driver can more appropriately support the obstacle avoidance operation.
次に、本発明に係る実施形態について図面を参照して説明する。
図1は、本実施形態の車両用障害物回避支援装置を装備した自車両の装置構成の概念図である。
(構成)
図1に示す自車両の例は、前輪操舵の車両の例である。
自車両SWには、次のような種々のセンサ類を装備する。そのセンサ類は、複数台のカメラ1、車速センサ2、ヨーレートセンサ3、加速度センサ4、及び操舵角センサ5である。これらセンサ類は、検出信号を回避支援コントローラ6に出力する。
Next, an embodiment according to the present invention will be described with reference to the drawings.
FIG. 1 is a conceptual diagram of a device configuration of a host vehicle equipped with the vehicle obstacle avoidance assistance device of the present embodiment.
(Constitution)
The example of the host vehicle shown in FIG. 1 is an example of a vehicle with front wheel steering.
The own vehicle SW is equipped with the following various sensors. The sensors are a plurality of
カメラ1は、例えば車室内前方に設けてある。カメラ1は、自車両SW前方の道路状況を撮影することで、自車両SW前方の情報を検出する。自車両SW前方の情報としては、障害物、道路境界、白線等がある。カメラ1を2台で構成してステレオ形式とすることにより、物体の方向だけでなく、距離も検出可能な構成としている。なお、自車両SW前方ばかりでなく、側方の情報なども取得しても良い。なお、距離について、別途レーザ光などによって取得しても良い。
The
車速センサ2は、車輪の回転数を検出する。例えば、車輪に取り付けたロータリーエンコーダ等が利用可能である。そして、車輪の回転に比例して発生するパルス信号を検出することで車速を計測する。
ヨーレートセンサ3は、車両に発生するヨーレートを検出する。例えば、水晶振動子や半導体を用いて構成したデバイスを利用する。
加速度センサ4は、車両に発生する特定の方向の加速度を検出する。例えば、圧電素子等を用いて構成したデバイスを利用する。本実施形態では、特に、車両の横方向に発生する加速度を検出する構成を想定する。
The
The
The
操舵角センサ5は、操舵の回転角度を検出する。例えば、ステアリングコラム内に設けて、ステアリングホイール8の回転角度を検出する。
また、車両には、警報装置としてのブザー7を備える。ブザー7は、回避支援コントローラ6からの信号に応じて警報音を発する。警報装置は、ステアリングホイール8に振動を付与したり、光を発したりする装置で構成しても良い。
回避支援コントローラ6は、マイクロプロセッサからなる。そのマイクロプロセッサは、A/D変換回路、D/A変換回路、中央演算処理装置、メモリ等から構成した集積回路を備える。そして、メモリに格納したプログラムに従って、各種センサで検出した信号の処理、障害物回避操作量集合の算出、及び回避支援の必要性判定を行い、その結果を、警報装置(ブザー7)に出力する。
The
The vehicle also includes a buzzer 7 as an alarm device. The buzzer 7 emits an alarm sound according to the signal from the
The
図2に、以上の装置構成を機能別にまとめたブロック図を示す。
自車両状態検出手段は、車両に取り付けた車速センサ2、操舵角センサ5、ヨーレートセンサ3、加速度センサ4およびカメラ1によって構成する。そして、各センサで検出した信号を統合的に処理して自車両SWの運動・操作状態(車両状態)に関する情報を得る機能を実現する。
これらのセンサのうち、カメラ1は、障害物検出手段および道路境界検出手段としての用途を兼ねており、撮像したイメージを画像処理して障害物や道路境界の情報を抽出する機能を実現する。
FIG. 2 is a block diagram summarizing the above-described device configuration by function.
The own vehicle state detection means includes a
Among these sensors, the
次に、回避支援コントローラ6について説明する。
回避支援コントローラ6は、図2に示すように、センサ信号処理部6A、回避可能集合算出手段6B、回避支援起動判定手段6C、及び回避支援出力手段6Dを備える。
センサ信号処理部6Aは、各センサからの信号に基づく情報を処理して、同一の座標上に展開した情報へ変換する。変換した情報は、回避可能集合算出手段6Bに出力する。なお、カメラ1からの画像情報について画像処理を行い、障害物や道路境界情報を抽出する。この抽出処理は、カメラ1側に持っていても良い。また、センサ信号処理部6Aは、各センサからの信号に基づく情報から、自車両SWの運動状態(走行状態)、及び操作状態を取得する。
Next, the
As shown in FIG. 2, the
The sensor
上記回避可能集合算出手段6Bは、走行可能領域算出手段6Baと、回避可能操作量集合算出手段6Bbの2つの処理部を備える。
走行可能領域算出手段6Baは、自車両SWが走行可能な走行可能領域Pを算出する。すなわち、道路境界検出手段としてのカメラ1が検出した情報に基づき、道路境界の内側の領域である走路領域を求める。また障害物検出手段としてのカメラ1が検出した情報に基づき、障害物の占有領域を求める。障害物の占有領域は、自車両SWがその占有領域内に進入すると障害物と接触してしまう可能性が高い領域である。そして、走路領域から、障害物の占有領域を除いた領域を、上記走行可能領域Pとして算出する。
The avoidable
The travelable area calculation means 6Ba calculates a travelable area P in which the host vehicle SW can travel. That is, based on the information detected by the
回避可能操作量集合算出手段6Bbは、自車両SWの運動状態および走行可能領域Pに基づき、回避可能操作量集合を算出する。回避可能操作量集合は、所定時間後の間までに、自車両SWが走行可能領域P内に留まることが可能な車両操作量の時系列の集合である。
このとき、回避可能操作量集合は、運転者が取り得る車両操作量の推定される限界を満たす範囲内に制限する。また、回避可能操作量集合は、許容される自車両の車両運動状態の推定される限界を満たす範囲内に制限する。
The avoidable operation amount set calculating means 6Bb calculates an avoidable operation amount set based on the motion state of the host vehicle SW and the travelable region P. The avoidable operation amount set is a time-series set of vehicle operation amounts in which the host vehicle SW can stay in the travelable area P until a predetermined time later.
At this time, the avoidable operation amount set is limited to a range that satisfies the estimated limit of the vehicle operation amount that the driver can take. Further, the avoidable operation amount set is limited to a range that satisfies the estimated limit of the allowable vehicle motion state of the host vehicle.
算出した回避可能操作量集合は、回避支援起動判定手段6Cに出力する。
回避支援起動判定手段6Cは、上記回避可能操作量集合と、センサ信号処理部6Aで算出した現在の自車両SWの操作量(操作状態)とを比較して、運転者に回避支援のための働きかけを行う必要があるか否かを判定する。「運転者に回避支援のための働きかけを行う必要がある」とは、障害物を回避し得る操作量の集合と、運転者の操作量とを比較することによって、障害物との接触リスクを判定し、接触リスクが高いと判定した場合である。
The calculated avoidable operation amount set is output to the avoidance support
The avoidance support activation determination means 6C compares the avoidable operation amount set with the current operation amount (operation state) of the host vehicle SW calculated by the sensor
本実施形態では、運転者の将来の予測される操作量が、回避可能集合から逸脱すると予測した場合も、運転者に回避支援のための働きかけを行う必要があると判定する。
回避支援出力手段6Dは、回避支援起動判定手段6Cによって、働きかけを行う必要があると判定すると、ブザー7に対し鳴らすための指令信号を発生する。
In this embodiment, even when it is predicted that the driver's predicted operation amount in the future deviates from the avoidable set, it is determined that the driver needs to be encouraged for avoidance support.
The avoidance
次に、上記回避支援コントローラ6の処理について、図3及び図4を参照して説明する。
ここでは、具体性を持たせて処理を分かりやすくするために、図5に示す場面を想定して説明する。図5に示す場面では、自車両SWが片側車線側の直線道路を走行している時に、自車両SW前方の走行路左側に障害物SMを検出した場面を想定している。
なお、図3の処理は、所定のサンプリング周期で繰り返し実行する。
Next, the process of the
Here, in order to make the processing easy to understand by giving concreteness, description will be made assuming the scene shown in FIG. In the scene shown in FIG. 5, a scene is assumed in which an obstacle SM is detected on the left side of the traveling road ahead of the host vehicle SW while the host vehicle SW is traveling on a straight road on one side lane.
Note that the process of FIG. 3 is repeatedly executed at a predetermined sampling period.
まずステップS100では、各種センサが検出した信号をメモリ上に読み込む。そして、自車両SWの運動状態および障害物SMの状態を、統一した所定の座標系上の値として算出する。上記座標系は、適当に設定することが可能である。本実施形態では、図5に示すように、道路の進行方向に沿った方向にX軸を、そのX軸と垂直方向(路幅方向)にY軸を設定する。また、本実施形態の説明では、上記座標系は、X座標の原点を自車両SWの現在位置に設定し、且つY座標の原点を道路の中心線付近に設定する。 First, in step S100, signals detected by various sensors are read into the memory. Then, the motion state of the host vehicle SW and the state of the obstacle SM are calculated as values on a predetermined unified coordinate system. The coordinate system can be set appropriately. In this embodiment, as shown in FIG. 5, the X axis is set in the direction along the traveling direction of the road, and the Y axis is set in the direction perpendicular to the X axis (road width direction). In the description of the present embodiment, the coordinate system sets the origin of the X coordinate to the current position of the host vehicle SW, and sets the origin of the Y coordinate near the center line of the road.
上記座標系を設定することで、自車両SW(中心点)の位置を(X、Y)=(x、y)といった形で表記することができるようになる。
また、自車両SWの運動状態を表す状態量として、ヨー角θ、車両の縦方向速度vx、横方向速度vy、ヨーレートγ、前輪の転舵角δが重要な物理量であると考える。これらの自車両SWの運動状態を記述する物理量は、次に説明するように、センサの検出信号を処理することによって、具体的な値を取得できる。
By setting the coordinate system, the position of the host vehicle SW (center point) can be expressed in the form of (X, Y) = (x, y).
Further, it is considered that the yaw angle θ, the longitudinal speed v x , the lateral speed v y , the yaw rate γ, and the turning angle δ of the front wheels are important physical quantities as state quantities representing the motion state of the host vehicle SW. As described below, the physical quantities describing the motion state of the host vehicle SW can be obtained with specific values by processing the detection signals of the sensors.
すなわち、これらの状態量(物理量)のうち縦方向速度vxに関しては、当該縦方向速度vxに比べて横方向速度vyが十分に小さいとみなせれば、縦方向速度vxは非駆動輪の車輪速で近似することができる。従って、縦方向速度vxは、非駆動輪にとりつけた車速センサ2の検出値から求めることが出来る。
また、ヨーレートγは、ヨーレートセンサ3から得ることができる。
車両ヨー角θは、道路が直線であると仮定すれば、道路境界と自車の向いている方向とのなす角を、画像処理によって推定することで求めることができる。あるいは、適当な初期値を定めて、ヨーレートセンサ3の出力値を積分することで算出してもよい。
また、横方向速度vyは、車両横加速度を測定する加速度センサ4の出力を積分することによって求めることができる。
That is, for the longitudinal velocity v x of the amount of these states (physical quantity), if Minasere lateral velocity v y as compared to the longitudinal velocity v x is sufficiently small, longitudinal velocity v x undriven It can be approximated by the wheel speed of the wheel. Therefore, the longitudinal speed v x can be obtained from the detection value of the
The yaw rate γ can be obtained from the
Assuming that the road is a straight line, the vehicle yaw angle θ can be obtained by estimating the angle formed by the road boundary and the direction in which the vehicle is facing by image processing. Alternatively, it may be calculated by determining an appropriate initial value and integrating the output value of the
Further, the lateral velocity v y can be obtained by integrating the output of the
前輪舵角δは、操舵角センサ5から取得することができる。
また、障害物SMを検出している場合には、障害物SMの中心点の位置座標Xp=(xp、yp)、および障害物SMの幅σy、及び奥行きσxの各値を、カメラ1で取得した画像情報を処理することによって算出する。奥行きσxは、撮影方向によっては測定が困難な場合もある。奥行きの測定が困難な場合には、例えば便宜的に、幅σyと同じ値を設定しておく。なお、障害物SMを検出しなかった場合には、障害物SMに関する物理量の算出を行わない。
また、道路の左端および右端の位置を、上記座標系上の値に変換して、それぞれY=YL、Y=YRとする。道路の左端および右端の位置は、カメラ1による道路境界検出によって検出する。
The front wheel steering angle δ can be acquired from the
When the obstacle SM is detected, the position coordinates Xp = (x p , y p ) of the center point of the obstacle SM and the values of the width σy and the depth σx of the obstacle SM This is calculated by processing the image information acquired in 1. The depth σx may be difficult to measure depending on the shooting direction. If it is difficult to measure the depth, for example, the same value as the width σy is set for convenience. When no obstacle SM is detected, the physical quantity relating to the obstacle SM is not calculated.
Further, the positions of the left end and the right end of the road are converted into values on the coordinate system, and Y = YL and Y = YR, respectively. The positions of the left end and the right end of the road are detected by road boundary detection by the
図5の場面において導入した座標系と、物理量との例を図6に示す。
以上のように、ステップS100では、統一した座標系を設定し、自車両SW、障害物SMおよび道路境界に関する情報を、導入した座標系上の値として算出する。
次に、ステップS200では、障害物SMの検出の有無によって処理を分岐する。障害物SMを検出した場合には、ステップS300に移行する。一方、障害物SMを検出しなかった場合には、支援の必要性がないと判定し、処理を終了して復帰する。
なお、障害物SMを検出している場合でも、自車両SWとの距離が大きい場合など、自車両SWと接触するリスクが小さい場合には、障害物SMを検出しなかったものとして処理しても良い。
An example of the coordinate system and physical quantity introduced in the scene of FIG. 5 is shown in FIG.
As described above, in step S100, a unified coordinate system is set, and information related to the host vehicle SW, the obstacle SM, and the road boundary is calculated as a value on the introduced coordinate system.
Next, in step S200, the process branches depending on whether or not the obstacle SM is detected. When the obstacle SM is detected, the process proceeds to step S300. On the other hand, when the obstacle SM is not detected, it is determined that there is no need for assistance, and the processing is terminated and returned.
Even when the obstacle SM is detected, if the risk of contact with the host vehicle SW is small, such as when the distance to the host vehicle SW is large, the obstacle SM is treated as not detected. Also good.
ステップS300では、走行可能領域Pの算出を行う。走行可能領域Pとは、自車両SWが障害物SMと接触しない自車両SWの位置座標(x、y)の集合である。
ここで、自車両SWの位置座標(x、y)と障害物SMの位置座標xp(xp、yp)との間の関係として、走行可能領域Pを定義する場合を考える。この場合、自車両SWの長さをL、幅をWとすると、障害物SMの奥行き及び幅よりも、それぞれ(L/2)、(W/2)だけ余計に中心点間の距離を確保する必要がある。これは、自車両SWの位置座標(x、y)を、自車両SWの中心点にとっている為である。
また、図5の場面では、障害物SMは走行路の左方向に存在している。このため、通常はより広い空間が開けている右方向に回避することになる。そこで、障害物SMの左側も便宜上走行不可能領域として扱うことにすると、走行可能領域Pは、図7に示したような領域として、以下のように定義することができる。
In step S300, the travelable area P is calculated. The travelable area P is a set of position coordinates (x, y) of the host vehicle SW in which the host vehicle SW does not contact the obstacle SM.
Here, a case is considered in which the travelable region P is defined as a relationship between the position coordinates (x, y) of the host vehicle SW and the position coordinates xp (x p , y p ) of the obstacle SM. In this case, if the length of the host vehicle SW is L and the width is W, the distance between the center points is further secured by (L / 2) and (W / 2) respectively than the depth and width of the obstacle SM. There is a need to. This is because the position coordinates (x, y) of the host vehicle SW are set at the center point of the host vehicle SW.
Moreover, in the scene of FIG. 5, the obstacle SM exists in the left direction of the traveling road. For this reason, it is usually avoided in the right direction where a wider space is open. Therefore, if the left side of the obstacle SM is also treated as a non-travelable area for convenience, the travelable area P can be defined as an area as shown in FIG. 7 as follows.
以上のようにステップS300は、走行可能領域Pを定義する処理を行う。
続いてステップS400では、回避可能操作量集合の算出を行う。
上記走行可能領域Pは、物理的に自車両SWと障害物SMが接触しない範囲を求めたものである。しかし、自車両SWの運動にはいくつかの物理的拘束が存在する。このために、自車両SWは走行可能領域P内を自由に運動できるわけではない。従って、走行可能領域Pと自車両SWとの位置関係だけで回避支援の必要性を精度良く判定することは、困難となるおそれある。
As described above, step S300 performs the process of defining the travelable area P.
Subsequently, in step S400, an avoidable operation amount set is calculated.
The travelable area P is a range in which the host vehicle SW and the obstacle SM do not physically come into contact with each other. However, there are some physical constraints on the motion of the host vehicle SW. For this reason, the own vehicle SW cannot move freely in the travelable area P. Therefore, it may be difficult to accurately determine the necessity of avoidance support based only on the positional relationship between the travelable area P and the host vehicle SW.
そして、回避支援の必要性を判定するためには、次の2点を把握しておくことが重要である。
その2点とは、
a)現在、運転者が行っている操作量が、自車両SWが将来にわたって走行可能領域P内に留まり続けることができる操作量全体の集合の中に、含まれているかどうかを把握すること。
b)含まれているとすれば、回避不可能となるまでの余裕がどの程度残されているのかを把握すること。
である。
And in order to determine the necessity of avoidance support, it is important to grasp the following two points.
The two points are
a) To grasp whether or not the operation amount that the driver is currently performing is included in the set of all operation amounts that the vehicle SW can continue to stay in the travelable area P in the future.
b) If it is included, grasp how much room is left until it cannot be avoided.
It is.
そして、回避可能操作量集合を算出するために、まず自車両SWの運動を記述するモデルを導入する。ここでは、車両の運動を記述するモデルとして、四輪車両の運動を二輪車両の運動で近似する二輪モデルを使用する。
この二輪モデルは、走行速度が一定で、ヨー角θが十分に小さく、横方向速度vyが縦方向速度vxと比較して十分に小さく、タイヤ横力の飽和特性が顕著に現れない運動状態では、次式のように近似することができる。
In order to calculate the avoidable operation amount set, first, a model describing the motion of the host vehicle SW is introduced. Here, a two-wheel model that approximates the movement of a four-wheel vehicle by the movement of a two-wheel vehicle is used as a model that describes the movement of the vehicle.
In this two-wheel model, the running speed is constant, the yaw angle θ is sufficiently small, the lateral speed v y is sufficiently smaller than the longitudinal speed v x, and the tire lateral force saturation characteristic does not appear remarkably. The state can be approximated as:
ここで、
m:車両質量
I:車両ヨー慣性モーメント
Lf:車両重心から前輪軸までの距離
Lr:車両重心から後輪軸までの距離
Cf:前輪コーナリングパワー係数
Cr:後輪コーナリングパワー係数
δv:転舵角速度
である。
上記(3)〜(8)式は、自車両SWの運動状態を記述する状態ベクトルとして、
here,
m: vehicle mass I: vehicle yaw moment of inertia Lf: distance from vehicle center of gravity to front wheel axis Lr: distance from vehicle center of gravity to rear wheel axis Cf: front wheel cornering power coefficient Cr: rear wheel cornering power coefficient δv: turning angular velocity .
The above equations (3) to (8) are expressed as state vectors describing the motion state of the host vehicle SW.
以上のようにして導入したモデルを用いると、操舵入力δvに対する車両運動の予測計算を行うことができる。現時刻において測定した状態ベクトルをx0=x(1)とすると、nステップ先の時刻における状態ベクトルの予測値は(11)式から、
When the model introduced as described above is used, it is possible to perform prediction calculation of vehicle motion with respect to the steering input δv. If the state vector measured at the current time is x 0 = x (1), the predicted value of the state vector at the time n steps ahead is
ここで、
here,
ここでは、現在からT秒先までの状態ベクトルを予測するものとして、n=1からN=(T/Δt)まで、(12)式に従って状態ベクトルx(n+l)を計算する。計算した状態ベクトルの時系列は、操舵入力δvを加えた場合の自車両SWの予測走行軌跡を表す。ただし、自車両SWの走行軌跡は、(1)式、(2)式で定義した走行可能領域Pの内部に留まっている必要がある。
また、転舵角δは車両操舵系の仕様によって最大転舵角δmaxが決まっており、予側転舵角の値がδmaxを超える走行軌跡は実現不可能である。すなわち、自車両SWの走行軌跡は、次式で定義する実現可能状態Qの内部に留まっていることも要求される。
Here, assuming that the state vector from the present to T seconds ahead is predicted, the state vector x (n + l) is calculated from n = 1 to N = (T / Δt) according to the equation (12). The time series of the calculated state vector represents the predicted traveling locus of the host vehicle SW when the steering input δv is added. However, the travel locus of the host vehicle SW needs to remain within the travelable area P defined by the equations (1) and (2).
Further, the maximum turning angle δ max is determined for the turning angle δ according to the specifications of the vehicle steering system, and a travel locus in which the value of the pre-side turning angle exceeds δ max cannot be realized. That is, it is also required that the traveling locus of the host vehicle SW stays within the realizable state Q defined by the following equation.
なお、走行可能領域Pは、(1)式において、yの制限値yminが縦方向の位置xに依存して変化するものとして定義している。しかし、縦方向速度vxが一定という条件のもとでは、(3)式から、xの値がステップ数nによって一意に決まる。このため、(14)式では、制限値yminをステップ数nに依存して変化する関数として扱っている。
そして、自車両走行軌跡がPおよびQの内部に留まるためには、(15)式が、n=1、2、…、Nの各ステップについて成立していなければならない。ここで、状態ベクトルxと操作入力の時系列UNとの間には、(12)式の関係が成立する。したがって、(15)式の条件を並べると、
Note that the travelable area P is defined in the formula (1) as a limit value y min of y that varies depending on the position x in the vertical direction. However, under the condition that the vertical velocity v x is constant, the value of x is uniquely determined by the number of steps n from Equation (3). For this reason, in the equation (14), the limit value y min is treated as a function that varies depending on the number of steps n.
In order for the own vehicle travel locus to remain inside P and Q, equation (15) must be established for each step of n = 1, 2,. Here, between the time series U N of the state vector x and input operation, (12) the relationship equation is established. Therefore, when the conditions of equation (15) are arranged,
すなわち、回避可能操作量集合Sは、
That is, the avoidable manipulated variable set S is
このように、ステップS400で具体的に実施する処理は、行列F、Gの算出である。
次に、ステップS500では、回避可能操作量集合Sに基づいて運転者の操作を評価する処理を行う。
基本的な考え方は、次の通りである。
すなわち、回避可能操作量集合Sのうち、極力小さな操作量で回避できる回避操作量時系列を、基準として算出する。その算出した基準回避操作量時系列の操作余裕を、回避可能操作量集合との境界との距離として算出し、その距離をもって評価値とする。
続いて、ステップS600では、ステップS500における判定結果をもとに、処理を分岐する。回避支援の必要性あり、あるいは回避不可能と判定した場合には、ステップS700に移行して、ブザー7への駆動信号を生成・出力して処理を終了する。一方、支援が不要であると判定した場合には、そのまま処理を終了する。
As described above, the processing specifically performed in step S400 is calculation of the matrices F and G.
Next, in step S500, processing for evaluating the driver's operation based on the avoidable operation amount set S is performed.
The basic idea is as follows.
That is, the avoidance operation amount time series that can be avoided with the smallest operation amount in the avoidable operation amount set S is calculated as a reference. The operation allowance of the calculated reference avoidance operation amount time series is calculated as a distance from the boundary with the avoidable operation amount set, and the distance is used as an evaluation value.
Subsequently, in step S600, the process branches based on the determination result in step S500. If it is determined that there is a need for avoidance support or that it is impossible to avoid, the process proceeds to step S700, a drive signal to the buzzer 7 is generated and output, and the process ends. On the other hand, if it is determined that no assistance is required, the process is terminated as it is.
次に、上記ステップS500で行う、上記操作量の評価を、図4を参照して説明する。
まずステップS510では、ステップS400で算出した回避可能操作量集合Sが空集合であるかどうかの判定を行う。ここで、(18)式で表現できる線形不等式で定義した集合を満足する解があるかどうかの判定は、線形計画法の手法を用いることで、効率的に判定することができる。
Next, the evaluation of the manipulated variable performed in step S500 will be described with reference to FIG.
First, in step S510, it is determined whether or not the avoidable operation amount set S calculated in step S400 is an empty set. Here, the determination of whether or not there is a solution satisfying the set defined by the linear inequality that can be expressed by the equation (18) can be efficiently performed by using a linear programming method.
回避可能操作量集合Sが空集合であると判定した場合には、ステップS580に移行して、回避不可能という判定を下して処理を終了する。ここで、空集合である場合には、障害物SMと接触せずに道路境界内部を走行し続ける操作が存在しないことを意味している。
一方、回避可能操作量集合Sが空集合でないと判定した場合には、ステップS520に移行する。
ステップS520では、回避可能操作量集合の中から極力小さな操作量で回避できる回避操作量時系列を、基準回避操作量時系列として算出する。この基準を求める処理は、回避可能操作量集合Sと運転者操作との間の関係を評価しやすくするために実施する。
具体的には、運転者操作量UNに対する評価関数として、
If it is determined that the avoidable manipulated variable set S is an empty set, the process proceeds to step S580, where it is determined that avoidable operation is not possible, and the process ends. Here, in the case of an empty set, it means that there is no operation to continue traveling inside the road boundary without contacting the obstacle SM.
On the other hand, if it is determined that the avoidable operation amount set S is not an empty set, the process proceeds to step S520.
In step S520, an avoidance operation amount time series that can be avoided with a minimum operation amount from the avoidable operation amount set is calculated as a reference avoidance operation amount time series. The process for obtaining the reference is performed in order to easily evaluate the relationship between the avoidable operation amount set S and the driver operation.
Specifically, as the evaluation function to the driver operating amount U N,
ここで、w1、w2、…、wNは重みパラメータである。
現在の運転者の操舵速度δdv(0)を利用する場合には、
Here, w 1 , w 2 ,..., W N are weight parameters.
When using the current driver's steering speed δ d v (0),
また、運転者が行うと予想できる操舵速度のパターンを、過去の履歴等から推定して、利用することができる場合には、
In addition, when the steering speed pattern that can be predicted by the driver can be estimated from the past history, etc., and can be used,
ここで、(19)式は、最も小さな操作量(転舵速度)で回避する操作を基準として利用する方法である。また、(20)式、及び(21)式は、運転者が行うと予想できる操作に対する補正量を、最も小さくする操作を基準として利用する方法である。
回避可能操作量集合Sの中から(19)式、あるいは(20)式、及び(21)式の評価関数を最小とする操作量時系列を、基準回避操作量時系列とする。
Here, equation (19) is a method that uses an operation to be avoided with the smallest operation amount (steering speed) as a reference. In addition, Expressions (20) and (21) are methods that use an operation that minimizes the correction amount for an operation that can be predicted by the driver as a reference.
The operation amount time series that minimizes the evaluation function of the expression (19), the expression (20), and the expression (21) from the avoidable operation amount set S is set as a reference avoidance operation amount time series.
具体的な基準回避操作量時系列の算出方法を(19)式を例にとって説明する。
新たなN個の正の変数L1、L2、…、LNを導入し、(19)式における
|δv(i)|、(i=1、2、…、N)を変数Liで置き換えた新たな評価関数L′を、次式のように導入する。
L′= w1・L1 +w2・L2 +…+wN・LN ・・・(22)
A specific reference avoidance operation amount time series calculation method will be described with reference to the equation (19).
Introduce new N positive variables L 1 , L 2 ,..., L N and replace | δv (i) |, (i = 1, 2,..., N) in equation (19) with the variable Li. A new evaluation function L ′ is introduced as shown in the following equation.
L ′ = w 1 · L 1 + w 2 · L 2 + ... + w N · L N (22)
新たな変数Liと、|δv(i)|とは、以下のような拘束で関連付けてあるとする。
−Li ≦δv(i)≦ Li (i=1、2、…、N)・・・(23)
また、変数Liは正と仮定して導入しているので、
Li ≧ 0 (i=1、2、…、N) ・・・(24)
という拘束も課す必要がある。
ここで、拘束条件(18)式、(23)式、(24)式、及び評価関数(19)式で定義する問題は、線形計画問題となる。したがって、効率良く解くためのアルゴリズムが知られている。そして、その公知のアルゴリズムを用いて、解{δ*v(i)}を得ることができる。
評価関数が(20)式や(21)式の場合も、同様にして解を得ることができる。
It is assumed that the new variable L i and | δv (i) | are related by the following constraints.
−L i ≦ δv (i) ≦ L i (i = 1, 2,..., N) (23)
Moreover, since the variable L i is introduced on the assumption that it is positive,
L i ≧ 0 (i = 1, 2,..., N) (24)
It is also necessary to impose such restrictions.
Here, the problem defined by the constraint conditions (18), (23), (24), and the evaluation function (19) is a linear programming problem. Therefore, an algorithm for efficiently solving is known. The solution {δ * v (i)} can be obtained using the known algorithm.
When the evaluation function is the expression (20) or the expression (21), a solution can be obtained in the same manner.
以上のようにステップS520の処理によって、基準解{δ*v(i)}を算出したら、ステップS530に移行する。
ステップS530では、上記基準解{δ*v(i)}を用いて、回避可能操作量集合Sの次元を小さくする変換を行う。これによって、操作量の評価を実施し易い形とする。
操作支援を考える場合、現在に近い未来の操作の方がより重要である。従って、所定時間経過した後は、基準解に沿った操作が行われるものと仮定しておいて、それよりも手前側の時刻における操作量の集合に注目することにする。
すなわち、操作量UNについて、以下のように、確定部分と未確定部分とに分割する。ここで、確定部分とは、基準解に沿って操作する区間である。未確定部分とは、運転者の自由な操作を想定する区間である。
As described above, when the reference solution {δ * v (i)} is calculated by the process of step S520, the process proceeds to step S530.
In step S530, conversion that reduces the dimension of the avoidable manipulated variable set S is performed using the reference solution {δ * v (i)}. This makes it easy to evaluate the operation amount.
When considering operation support, future operations close to the present are more important. Accordingly, it is assumed that an operation according to the reference solution is performed after a predetermined time has elapsed, and attention is paid to a set of operation amounts at a time earlier than that.
That is, the operation amount U N, as follows, divided into a deterministic part and unconfirmed portions. Here, the fixed part is a section operated along the reference solution. An undetermined part is a section which assumes a driver's free operation.
SKの平均は、最初のKステップで許容できる操作量の集合であると解釈することができる。ただし、(K+1)ステップ以降は、基準回避操作量時系列に沿って回避を行うことを前提とする。以上がステップS530の処理であり、SKの平均の算出が終わると、ステップS540に移行する。
ステップS540では、現在の操作状態がKステップ継続すると仮定した場合の操作に対する回避余裕を、SKの平均に基づいて評価する処理を行う。
ここで、SKの平均は、幾何学的に解釈すると、K次元空間上で定義できる多面体を構成する。一方、現在の操作状態δdv(0)がKステップ継続するということは、K次元空間上の点の中から、
The average of S K can be interpreted as a set of operation amounts that can be tolerated in the first K steps. However, after the (K + 1) step, it is assumed that the avoidance is performed along the reference avoidance operation amount time series. Or a process of steps S530, when the calculation of the average of S K is completed, the process proceeds to step S540.
In step S540, a process for evaluating an avoidance margin for an operation when it is assumed that the current operation state continues for K steps based on the average of S K is performed.
Here, the mean of S K constitutes a polyhedron that can be defined on a K-dimensional space when geometrically interpreted. On the other hand, the fact that the current operation state δ d v (0) continues for K steps means that points in the K-dimensional space are
このとき、UKとSKの平均との間の位置関係を調べることで、現在の操作状態を継続した場合の回避余裕を評価することができる。
すなわち、UKが多面体(SKの平均)の外側に出てしまっている場合には、UKを実行したのでは回避が不可能になることを意味している。UKがSKの平均の内部にある場合でも、SKの平均を構成する境界面に近い場所に位置している場合には、計算上は回避可能でも、回避限界までの余裕が小さい。つまり、測定誤差や制御誤差によって回避不可能になるリスクが高いと解釈できる。
At this time, by checking the positional relationship between U K and the average of S K , it is possible to evaluate the avoidance margin when the current operation state is continued.
That is, when U K has come out of the polyhedron (average of S K ), it means that avoidance is impossible by executing U K. Even if the U K is inside the average S K, when positioned in a location close to the boundary surface forming the average S K is a calculated also be avoided, a small margin to avoid the limit. In other words, it can be interpreted that there is a high risk of being unavoidable due to measurement errors and control errors.
そこで、まず(29)式のUKがSKの平均に属しているかどうかをチェックする。その後、UKについて、SKの平均の境界面までの距離dKを算出する。そして、算出した距離dKを、回避余裕の指標とする。UKとSKの平均の境界面までの距離dKの求め方には様々な方法を考えることが出来る。ここでは、一例として以下のような方法を例示する。
今、SKの平均に属しているUKの第k成分、すなわちkステップ目の入力がΔukだけ変化したとする。このとき、入力が変化しても障害物回避が可能になるためには、変化した入力もSKの平均に属している必要がある。つまり、
Therefore, first, it is checked whether or not U K in equation (29) belongs to the average of S K. Thereafter, the distance d K to the average boundary surface of S K is calculated for U K. The calculated distance d K is used as an index of avoidance margin. Various methods can be considered for obtaining the distance d K to the average boundary surface between U K and S K. Here, the following method is illustrated as an example.
Now, a k-th component of the U K belonging to the average of S K, that is, the input of the k-th step changes by Delta] u k. In this case, because the input is possible even obstacle avoidance changed, it is necessary to change the input also belong to the average of the S K. That means
ここで、△min k、及び△max kが、kステップ目の入力変化として許容される幅を表している。以上の許容範囲は、k=1、2、…、Kの各ステップについて算出することができる。
そこで、UKとSKの平均との距離dKを、以下のように定義する。
Here, Δ min k and Δ max k represent the allowable width as the input change of the k-th step. The above allowable range can be calculated for each step of k = 1, 2,.
Therefore, the distance d K between U K and the average of S K is defined as follows.
K=2の場合を例にとると、SKの平均、UK、△min k、△max k、dKは、図8のように図示することができる。
なお、UKがSKの平均に属していない場合には、便宜上、距離dKに、適当な負の値を割り当てておく。
以上のようにして、ステップS540では、UKとSKの平均との距離dKを算出する。
続いて、ステップS550では、算出した距離dKに基づいて処理を分岐する。
ここで、距離dKは、上述した通り回避余裕の指標である。そして、適当な閾値dthr(>0)を基準として、十分な回避余裕の有無を判定することができる。
すなわち、dK≧dthrである場合には、ステップS560に移行する。この場合には、十分な回避余裕があるものと判断する。そして、ステップS560で支援不要と判断して復帰する。
Taking the case of K = 2 as an example, the average of S K , U K , Δ min k , Δ max k , d K can be illustrated as shown in FIG.
If U K does not belong to the average of S K , an appropriate negative value is assigned to the distance d K for convenience.
As described above, in step S540, and calculates the distance d K of the average of the U K and S K.
Then, in step S550, the process branches based on the calculated distance d K.
Here, the distance d K is an index of avoidance margin as described above. The presence or absence of a sufficient avoidance margin can be determined based on the appropriate threshold value d thr (> 0).
That is, if d K ≧ d thr , the process proceeds to step S560. In this case, it is determined that there is a sufficient avoidance margin. In step S560, it is determined that support is unnecessary, and the process returns.
一方、dK<dthrである場合にはステップS570に移行する。この場合には、回避余裕が十分でないと判断する。そして支援が必要であると判断して復帰する。
以上がステップS500の処理である。
ここで、車速センサ2、操舵角センサ5、ヨーレートセンサ3、加速度センサ4およびカメラ1は、自車両状態検出手段を構成する。また、カメラ1は、障害物SM検出手段及び道路境界検出手段も構成する。回避支援出力手段御及び警報装置(ブザー7)は、回避支援手段を構成する。(20)式及び(21)式が運転者操作量予測手段を構成する。車両モデル、ステップS400、(13)式は、操作限界推定手段、車両運動限界推定手段を構成する。
On the other hand, if d K <d thr , the process proceeds to step S570. In this case, it is determined that the avoidance margin is not sufficient. Then, it decides that it needs assistance and returns.
The above is the process of step S500.
Here, the
(動作)
定期的に、各センサからの信号に基づき、自車両SWの運動状態や障害物情報、道路境界情報を取得し、同一の座標上に展開した情報に変換する。
その同一座標に展開した情報によって、自車両SWが走行可能な走行可能領域Pを算出する。すなわち、道路境界の内側の領域である走路領域を求めると共に、障害物SMの占有領域を求める。そして、走路領域から、障害物SMの占有領域を除いた領域を、上記走行可能領域Pとして算出する。
(Operation)
Periodically, based on signals from each sensor, the movement state, obstacle information, and road boundary information of the host vehicle SW are acquired and converted into information developed on the same coordinates.
A travelable region P in which the host vehicle SW can travel is calculated based on the information developed on the same coordinates. That is, the road area that is the area inside the road boundary is obtained, and the occupied area of the obstacle SM is obtained. And the area | region remove | excluding the occupation area of the obstruction SM from the runway area is calculated as the said travelable area P.
続いて、車両の運動状態および走行可能領域Pに基づき、回避可能操作量集合を算出する。回避可能操作量集合は、所定時間後の間までに、自車両SWが走行可能領域P内に留まることが可能な車両操作量の時系列の集合である。
そして、上記回避可能操作量集合と、現在の自車両SWの操作量(操作状態)とを比較して、運転者に回避支援のための働きかけを行う必要があるか否かを判定する。働きかけを行う必要があると判定すると、ブザー7(警報装置)に対し警報発生のための指令信号を発生する。
Subsequently, an avoidable operation amount set is calculated based on the motion state of the vehicle and the travelable region P. The avoidable operation amount set is a time-series set of vehicle operation amounts in which the host vehicle SW can stay in the travelable area P until a predetermined time later.
Then, the avoidable operation amount set is compared with the current operation amount (operation state) of the host vehicle SW, and it is determined whether or not the driver needs to be engaged in avoidance support. If it is determined that it is necessary to act, a command signal for generating an alarm is generated for the buzzer 7 (alarm device).
以上のことが定期的に繰り返される。
これによって、回避可能な操作量時系列を含む回避可能操作量集合に基づいて運転者の行っている操作を評価することができる。この結果、運転者の回避意図を考慮しつつ回避操作が不十分である場合にのみ警報で運転者に障害物SMとの接触の危険性を報知する動作を実現することができる。
また、回避可能操作量集合は自車両SWが直進状態にはない条件でも算出することができる。したがって、回避の初動段階だけでなく回避操作を開始した後でも運転者の操作が不適切な場合に警報で危険を報知することができる。
The above is repeated periodically.
Thus, the operation performed by the driver can be evaluated based on the avoidable operation amount set including the avoidable operation amount time series. As a result, it is possible to realize an operation of notifying the driver of the risk of contact with the obstacle SM with an alarm only when the avoidance operation is insufficient while considering the driver's intention to avoid.
Further, the avoidable operation amount set can be calculated even under a condition where the host vehicle SW is not in the straight traveling state. Therefore, not only the initial stage of avoidance but also after starting the avoidance operation, the danger can be notified by an alarm when the driver's operation is inappropriate.
(本実施形態の効果)
(1)所定時間後までの間に接触することなく走行可能な自車両状態の範囲である回避可能集合を算出し、その回避可能集合の境界と、現在の自車両状態とで回避操作支援の必要性の有無を判定する。
このため、障害物SMとの距離だけに基づいて回避可能性の判定をする場合と比較して、回避操作支援の必要性の判定を精度良く実行可能となる。この結果、運転者による障害物回避操作をより適切に支援できることようになる。
(Effect of this embodiment)
(1) The avoidable set that is the range of the own vehicle state that can be driven without contact until after a predetermined time is calculated, and the avoidance operation support is calculated based on the boundary of the avoidable set and the current own vehicle state. Determine the necessity.
For this reason, compared with the case where the possibility of avoidance is determined based only on the distance to the obstacle SM, it is possible to accurately determine the necessity of the avoidance operation support. As a result, the driver can more appropriately support the obstacle avoidance operation.
(2)回避可能集合算出手段及び回避支援起動判定手段を備える。
回避可能集合算出手段は、自車両SWの任意の走行状態および操作状態に対して、回避成功に至る将来の走行状態の推移としてあり得るパターンのすべてを集合として算出する構成となっている。このため、回避の初動段階だけでなく回避中のすべての局面において適正な運動状態および操作状態の範囲を知ることができる。この結果、回避支援起動判定手段は、回避中のすべての局面において回避操作支援の必要性を精度よく判定することができるようになる、よって、必要な支援の提供と不要な支援の抑制を両立した障害物回避支援を提供することができる。
(2) An avoidable set calculation unit and an avoidance support activation determination unit are provided.
The avoidable set calculation means is configured to calculate, as a set, all patterns that can be assumed as transitions of the future driving state leading to a successful avoidance for any driving state and operation state of the host vehicle SW. For this reason, it is possible to know the appropriate range of motion state and operation state not only in the initial stage of avoidance but also in all aspects being avoided. As a result, the avoidance support activation determination means can accurately determine the necessity of the avoidance operation support in all aspects being avoided, and thus provides both necessary support and suppression of unnecessary support. Obstacle avoidance assistance can be provided.
(3)道路境界検出手段を備える。
これによって、障害物SMとの接触に加えて、道路境界を考慮して回避可能集合の算出を行っている。この結果、障害物回避と路外逸脱防止とを両立した回避支援を提供することができる。
(4)走行可能領域算出手段、及び回避可能操作量集合算出手段を備える。
走行可能領域算出手段は、障害物SMの占有領域外を算出し、回避可能操作量集合算出手段は、障害物SMの占有領域外を通過する自車両操作量全体の集合を算出する構成とする。これによって、運転者による現在の操作の適否を直接判定することができる。この結果、適切な回避支援の必要性の判定を、効率良く実施することができる。
(3) A road boundary detection means is provided.
Thereby, in addition to the contact with the obstacle SM, the avoidable set is calculated in consideration of the road boundary. As a result, it is possible to provide avoidance support that achieves both obstacle avoidance and off-road departure prevention.
(4) A travelable area calculation unit and an avoidable operation amount set calculation unit are provided.
The travelable area calculating means calculates the outside of the occupied area of the obstacle SM, and the avoidable operation amount set calculating means calculates the set of the entire host vehicle operation amount passing outside the occupied area of the obstacle SM. . Thereby, it is possible to directly determine whether or not the current operation by the driver is appropriate. As a result, it is possible to efficiently determine the necessity of appropriate avoidance support.
(5)操作限界推定手段を備える。
すなわち、運転者の車両操作量の限界を考慮して回避可能操作量集合を算出する構成となっている。これによって、運転者が実際には操作できない非現実的な回避方法を想定してしまうことを排除できる。さらに、操作量限界を適切に推定することで運転者の技量に応じた回避支援の必要性の判定を行うことができる。
(6)車両運動限界推定手段を備える。
すなわち、車両運動状態に限界を設定して回避可能操作量集合を算出する構成となっている。これによって、車両の急激な運動による車両挙動予測の誤差が所定の水準以上に大きくなることを防止する。また、回避可能操作量集合の精度を保つことができる。
(5) An operation limit estimation unit is provided.
That is, the avoidable operation amount set is calculated in consideration of the limit of the driver's vehicle operation amount. This eliminates the assumption of an unrealistic avoidance method that the driver cannot actually operate. Furthermore, the necessity of avoidance support according to the skill of the driver can be determined by appropriately estimating the operation amount limit.
(6) Vehicle movement limit estimation means is provided.
That is, the avoidable operation amount set is calculated by setting a limit on the vehicle motion state. This prevents an error in predicting vehicle behavior due to a sudden movement of the vehicle from exceeding a predetermined level. In addition, the accuracy of the avoidable operation amount set can be maintained.
(7)回避可能集合算出手段は、新たな情報を検出するたびに回避可能集合を更新する構成とする。この結果、障害物SMの挙動や車両の運動が当初の予測とは異なるものになった場合でも、新たな状況に迅速に対応した回避支援を提供することができる。
(8)上記回避支援起動判定手段は、現在の自車両状態と回避可能集合の境界との距離が所定値未満になったと判定すると、回避操作支援が必要であると判定する。
すなわち、現在の自車両状態と回避可能集合の境界との距離に基づいて回避支援の必要性を判定する構成とする。これによって、障害物回避の成否を分ける限界条件に対して確保すべき余裕を設計者が任意の水準に設定して回避支援装置を設計することができる。
(7) The avoidable set calculation means is configured to update the avoidable set each time new information is detected. As a result, even when the behavior of the obstacle SM and the motion of the vehicle are different from the initial prediction, it is possible to provide avoidance support that can quickly cope with a new situation.
(8) When the avoidance support activation determination unit determines that the distance between the current host vehicle state and the boundary of the avoidable set is less than a predetermined value, it determines that the avoidance operation support is necessary.
That is, the necessity of avoidance support is determined based on the distance between the current host vehicle state and the boundary of the avoidable set. Thus, the avoidance support device can be designed by setting a margin to be secured to a limit condition for determining success or failure of obstacle avoidance at an arbitrary level.
(9)運転者操作量予測手段を備える。
これによって、運転者の将来の予測操作量を回避可能操作量集合に基づいて評価している。これによって、運転者の操作が適切な回避操作になっていない場合にそのことを早期に発見して回避支援を始めることができる。つまり、より効果的な回避支援を提供することができる。
(10)警報手段を備える。
これによって、音等の警報によって、回避操作の必要性の注意喚起を行う。これによって、運転者の操作に直接干渉しない支援を提供することができる。
(変形例)
(1)車両前方の障害物SMを検出して処理を行っている。車両側方や後方の障害物SMも検出して、回避可能集合を算出しても良い。より回避操作支援の必要性に判定精度が向上する。
(9) A driver operation amount prediction means is provided.
Thus, the driver's future predicted operation amount is evaluated based on the avoidable operation amount set. As a result, when the driver's operation is not an appropriate avoidance operation, this can be detected early and avoidance support can be started. That is, more effective avoidance support can be provided.
(10) Provide alarm means.
As a result, a warning such as a sound alerts the necessity of the avoidance operation. As a result, it is possible to provide assistance that does not directly interfere with the operation of the driver.
(Modification)
(1) The obstacle SM in front of the vehicle is detected and processed. The avoidable set may be calculated by detecting the obstacle SM on the side or the rear of the vehicle. The determination accuracy is improved due to the necessity of avoidance operation support.
(第2実施形態)
次に、第2実施形態について図面を参照しつつ説明する。なお、上記第1実施形態と同様な構成などについては同一の符号を付して説明する。
図9は、本実施形態の車両用障害物回避支援装置を装備した自車両SWの装置構成の概念図である。
(構成)
本実施形態の車両の基本構成は、上記第1実施形態と同様である。ただし、転舵アシストモータ12およびその周辺部品を備える。これによって、転舵アシストトルクをシステム側から制御できる構成となっている点が異なっている。
(Second Embodiment)
Next, a second embodiment will be described with reference to the drawings. In addition, the same code | symbol is attached | subjected and demonstrated about the structure similar to the said 1st Embodiment.
FIG. 9 is a conceptual diagram of a device configuration of the host vehicle SW equipped with the vehicle obstacle avoidance assistance device of the present embodiment.
(Constitution)
The basic configuration of the vehicle of the present embodiment is the same as that of the first embodiment. However, the steering assist
すなわち、操舵トルクセンサ10、転舵角センサ11、及びモータコントローラ13を備える。モータコントローラ13は、操舵トルクセンサ10、転舵角センサ11からの信号を入力して参照しつつ、回避可能操作量集合算出手段6Bbからの指令に応じて転舵アシストモータ12を駆動制御する。このように、転舵アシストトルクを制御することで回避支援を行う。
本実施形態の回避可能操作量集合算出手段6Bbにおける演算は、第1実施形態とほぼ同様である。ただし、回避操作の支援方法の変更に伴い、第1実施形態と若干の異なる部分がある。
That is, a
The calculation in the avoidable manipulated variable set calculation means 6Bb of this embodiment is almost the same as that of the first embodiment. However, with the change of the avoidance operation support method, there are some differences from the first embodiment.
次に、本実施形態の回避支援コントローラ6の処理を説明する。
ここで、第1実施形態と同様の図5の場面を想定するが、本実施形態では障害物SMが移動するケースの取り扱いについても説明する。
ここで、第2実施形態における回避支援コントローラ6の処理は、図10に示すように、上記第1実施形態における回避支援コントローラ6の処理(図3参照)と、処理の流れ自体はほぼ同じである。ただし、具体的な処理については相違点がある。
まずステップS1100では、各種センサから信号を読み取り変換処理などを行う。上述のステップS100と基本的に同じである。
Next, the process of the
Here, although the scene of FIG. 5 similar to 1st Embodiment is assumed, handling of the case where the obstacle SM moves is also demonstrated in this embodiment.
Here, as shown in FIG. 10, the process of the
First, in step S1100, signals are read from various sensors and converted. This is basically the same as step S100 described above.
ただし、障害物SMが移動することも考慮すると、障害物SMに関する情報としては、障害物SMの中心点の位置座標xp=(xp、yp)、障害物SMの幅σy、奥行σxに加えて、移動速度vp=(vx p、xy p)に関する情報も取得する必要がある。移動速度については、位置座標xpの値を数値微分して算出する方法や、カメラ1の差分画像等を用いて直接移動速度を推定する方法等を採用することで、取得することができる。
However, considering that the obstacle SM moves, the information regarding the obstacle SM includes the position coordinates xp = (x p , y p ) of the center point of the obstacle SM, the width σy, and the depth σx of the obstacle SM. In addition, it is necessary to acquire information regarding the moving speed v p = (v x p , x y p ). The moving speed can be obtained by adopting a method of calculating the value of the position coordinate xp by numerical differentiation, a method of directly estimating the moving speed using a difference image of the
ステップS1200では、障害物SM検出の判定処理を行う。上述のステップS200と同じである。
ステップS1300では、上述と同様に、走行可能領域Pの算出処理を行う。ただし、障害物SMが移動している場合には、移動情報を反映して領域を構成する必要がある。すなわち、障害物SMの中心位置xp=(xp、yp)は時間とともに、以下のように移動していく。
In step S1200, an obstacle SM detection determination process is performed. This is the same as step S200 described above.
In step S1300, the travelable area P is calculated as described above. However, when the obstacle SM is moving, it is necessary to configure the area reflecting the movement information. That is, the center position xp = (x p , y p ) of the obstacle SM moves as follows with time.
ステップS1400では、回避可能操作量集合の算出を行う。上記第1実施形態での処理と比較して、車両モデルと制約条件を変更する。
第1実施形態の車両モデルでは、転舵速度を入力とみなしたモデルを採用した。この第2実施形態では、運転者の転舵トルクを入力とみなすモデルを採用する場合で説明する。具体的には、上述の(3)〜(8)式に加えて、
In step S1400, an avoidable operation amount set is calculated. Compared with the processing in the first embodiment, the vehicle model and the constraint conditions are changed.
In the vehicle model of the first embodiment, a model in which the turning speed is regarded as an input is adopted. In the second embodiment, a case where a model that regards the driver's turning torque as an input will be described. Specifically, in addition to the above equations (3) to (8),
ここで、Tは転舵トルクである。また、ζ、ω、Kは、運転者の転舵トルクから転舵角までの特性を2次振動系近似した場合の特性パラメータを表す。
(39)式を導入したため、自車両SWの運動状態を記述する状態ベクトルは、
Here, T is a steering torque. Also, ζ, ω, and K represent characteristic parameters when the characteristic from the driver's turning torque to the turning angle is approximated by a secondary vibration system.
Since the equation (39) is introduced, the state vector describing the motion state of the host vehicle SW is
制約条件については、走行可能領域Pを定義する(37)式、及び転舵角制限である(13)式に加えて、ここでは入力転舵トルクTにも、以下のような制限を課す。
Regarding the constraint conditions, in addition to the expression (37) that defines the travelable region P and the expression (13) that is the turning angle restriction, the following restriction is also imposed on the input turning torque T.
さらに、(42)式に対応する条件として、
Furthermore, as a condition corresponding to the equation (42),
ステップS1500の処理は、算出対象が転舵速度δvから転舵トルクTに変わる以外は、第1実施形態の場合と同様である。最終的に、回避可能操作量集合SKの平均と、操作量ベクトルUKとの間の距離dKを算出する。
ステップS1600の処理は、第1実施形態と同じである。
ステップS1700では、算出したSKの平均、dKの値をもとに、転舵アシストトルクの指令値の算出を行う。
転舵アシストトルクを付加する処理は、第1実施形態と同様、dKの値が閾値dthrを下回った時に作用させるものとする。
作用させるアシストトルクの指令値は、回避可能操作量集合SKの平均を算出する過程で算出している基準解、すなわち回避可能操作量集合SNに属し、
The processing in step S1500 is the same as that in the first embodiment except that the calculation target is changed from the turning speed δv to the turning torque T. Finally, the distance d K between the average of the avoidable manipulated variable set S K and the manipulated variable vector U K is calculated.
The process in step S1600 is the same as that in the first embodiment.
In step S1700, the average of the calculated S K, the value of d K on the basis, to calculate the command value for turning assist torque.
The processing for adding the steering assist torque is performed when the value of d K falls below the threshold value d thr as in the first embodiment.
The command value of the assist torque to be applied belongs to the reference solution calculated in the process of calculating the average of the avoidable operation amount set S K , that is, the avoidable operation amount set S N.
つまり、
That means
算出したアシストトルクの指令値は、モータコントローラ13に出力する。モータコントローラ13は、入力した指令値となるようにアシストトルクを操舵軸に入力する。
ここで、(42)式は、操作限界推定手段、車両運動限界推定手段を構成する。またステップS1300は、障害物挙動予測手段を構成する。
The calculated assist torque command value is output to the
Here, the equation (42) constitutes an operation limit estimating means and a vehicle motion limit estimating means. Step S1300 constitutes obstacle behavior prediction means.
(動作)
以上の処理を所定の制御周期ごとに繰り返すことで、各時刻におけるアシストトルク指令値を算出・制御することで回避支援を実現する。
この実施形態では、運転者が十分な余裕をもって回避操作を行っている場合にはアシストトルクの発生を抑制して違和感を与えることを抑制している。そして、回避余裕が小さくなったところでアシストトルクを発生させて回避を支援することで、効果的な回避支援を提供することができる。
(Operation)
By repeating the above processing every predetermined control period, avoidance support is realized by calculating and controlling the assist torque command value at each time.
In this embodiment, when the driver is performing the avoidance operation with a sufficient margin, the generation of the assist torque is suppressed to prevent the driver from feeling uncomfortable. Then, effective avoidance support can be provided by assisting avoidance by generating assist torque when the avoidance margin becomes small.
(本実施形態の効果)
(1)上記第1実施形態の効果に加えて、以下の効果を有する。
(2)障害物挙動予測手段を備える。
すなわち、障害物SMの移動経路を予測して回避可能操作量集合を算出する構成としている。この結果、移動する障害物SMに対しても有効な回避可能操作量集合を算出することができる。
(3)上記回避支援手段は、自車両状態が回避可能集合の内部に留まる方向にステアリング反力トルクを加える。
これによって、ステアリング反力トルクによって回避に有効な操舵方向を提示する。この結果、運転操作と直結したわかりやすい回避支援を提供することができる。
(Effect of this embodiment)
(1) In addition to the effects of the first embodiment, the following effects are obtained.
(2) An obstacle behavior prediction means is provided.
That is, the avoidable manipulated variable set is calculated by predicting the movement route of the obstacle SM. As a result, it is possible to calculate an avoidable manipulated variable set that is effective even for the moving obstacle SM.
(3) The avoidance support means applies a steering reaction torque in a direction in which the host vehicle state remains inside the avoidable set.
This presents a steering direction effective for avoidance by the steering reaction torque. As a result, it is possible to provide easy-to-understand avoidance support that is directly connected to the driving operation.
(第3実施形態)
次に、第3実施形態について図面を参照しつつ説明する。なお、上記各実施形態と同様な構成などについては同一の符号を使用する。
図11は、本実施形態の車両用障害物回避支援装置を装備した自車両SWの装置構成の概念図である。
(構成)
本実施形態の基本的な車両構成は、図12に示すように、上記第2実施形態と同様である。
(Third embodiment)
Next, a third embodiment will be described with reference to the drawings. In addition, the same code | symbol is used about the same structure as said each embodiment.
FIG. 11 is a conceptual diagram of the device configuration of the host vehicle SW equipped with the vehicle obstacle avoidance assistance device of the present embodiment.
(Constitution)
The basic vehicle configuration of the present embodiment is the same as that of the second embodiment as shown in FIG.
ただし、ステアリング軸の軸方向途中位置にクラッチ21を介装している。このクラッチ21によって、ステアリングホイール8による操舵を機械的に切り離し、転舵モータ22をシステム側で制御することによって転舵角を運転者操舵とは独立に制御できる構成となっている。
そして、第3実施形態の構成では、回避可能操作量集合算出手段6Bbの計算結果を用いて、回避余裕が所定の水準以下に小さくなったところで、転舵角をシステム側で制御する構成に切り替えることで回避を行う。
However, a clutch 21 is interposed at an intermediate position in the axial direction of the steering shaft. By this clutch 21, the steering by the
In the configuration of the third embodiment, the calculation result of the avoidable operation amount set calculation unit 6Bb is used to switch to a configuration in which the turning angle is controlled on the system side when the avoidance margin has become smaller than a predetermined level. To avoid it.
次に、本実施形態における回避支援コントローラ6の処理について。図12を参照しつつ説明する。
まずステップS2100にて、各種センサから信号を読み込み処理を行う。処理は、第1実施形態におけるステップS100と同じ処理である。
続いて、ステップS2200では、回避制御を実行中かどうかで処理を分岐する。既に以前の制御周期において回避制御が起動している場合には、ステップS3000へ移行する。一方、以前の制御周期において回避制御が起動していない場合にはステップ2300に移行する。
Next, the processing of the
First, in step S2100, signals are read from various sensors and processed. The process is the same as step S100 in the first embodiment.
Subsequently, in step S2200, the process branches depending on whether avoidance control is being executed. If the avoidance control has already been activated in the previous control cycle, the process proceeds to step S3000. On the other hand, if avoidance control has not been activated in the previous control cycle, the routine proceeds to step 2300.
ステップS2300では、障害物SM検出の判定を行う。処理は、第1実施形態におけるステップS300と同じ処理である。
続く、ステップS2400〜S2700までの処理も、第1実施形態のステップS300〜S600と同じ処理を行う。
そして、ステップS2700にて、回避余裕が小さいと判定された場合には、ステップS2800に移行する。ステップS2800では、回避制御を起動した後に、ステップS2900に移行する。上記回避制御は、起動する際に、クラッチ21に切り離し指令を出力して、クラッチ21を開放する。
In step S2300, the obstacle SM detection is determined. The process is the same as step S300 in the first embodiment.
The subsequent processes from step S2400 to S2700 are the same as steps S300 to S600 of the first embodiment.
If it is determined in step S2700 that the avoidance margin is small, the process proceeds to step S2800. In step S2800, after starting avoidance control, the process proceeds to step S2900. When the avoidance control starts, it outputs a disconnection command to the clutch 21 to release the clutch 21.
ステップS2900では、ステップS2500で算出した基準解{δ*v(i)}のうち、現在時刻に対応したステップ数iに対応した指令値を順番に読み出し、モータコントローラ1310に指令値として出力する。
すなわち、回避制御が起動中は、次の制御周期においてステップS2200でステップS3000に分岐して上記ステップS2900移行することで、基準解として算出した制御指令値が逐次実行していく。そして、ステップ数Nまでのすべての指令値を読み出すと、回避制御終了となって、ステップS3000でからステップS3100に移行する。
ステップS3100では、回避制御を終了するとしてクラッチ21に締結指令を出力して、通常走行状態に復帰する。
In step S2900, command values corresponding to the number of steps i corresponding to the current time are sequentially read out of the reference solution {δ * v (i)} calculated in step S2500 and output to the motor controller 1310 as command values.
That is, while the avoidance control is activated, the control command value calculated as the reference solution is sequentially executed by branching to step S3000 in step S2200 and shifting to step S2900 in the next control cycle. Then, when all the command values up to the number of steps N are read, the avoidance control ends, and the process proceeds from step S3000 to step S3100.
In step S3100, the avoidance control is terminated and an engagement command is output to the clutch 21 to return to the normal traveling state.
(動作)
回避余裕が小さくなって回避のために正確な操作が要求される場面では、クラッチ21が開放状態となる。これによって、運転者による操舵操作を停止して、回避支援装置によって操舵制御だけで障害物回避を行う。
また、クラッチ21を開放することで、回避支援装置によって操舵がステアリングホイール8に反映することが無い。
(Operation)
In a scene where the avoidance margin becomes small and an accurate operation is required for avoidance, the clutch 21 is released. Thus, the steering operation by the driver is stopped, and the obstacle avoidance is performed only by the steering control by the avoidance support device.
Further, by releasing the clutch 21, the steering is not reflected on the
(本実施形態の効果)
(1)上記第1及び第2実施形態の効果に加えて、以下の効果を有する。
(2)ステアリングホイールから操舵輪までのトルク伝達経路にクラッチを介装し、回避操作を支援する場合には、クラッチを開放状態とする。
これによって、回避余裕が小さくなって回避のために正確な操作が要求されるような局面においては、運転者の操作からシステムに制御が切り替わる。このため、運転者の技量によらず正確な回避操作を実現することができる。
(Effect of this embodiment)
(1) In addition to the effects of the first and second embodiments, the following effects are obtained.
(2) When a clutch is interposed in the torque transmission path from the steering wheel to the steering wheel and assisting the avoidance operation, the clutch is brought into an open state.
As a result, in a situation where the avoidance margin is small and an accurate operation is required for avoidance, the control is switched from the driver's operation to the system. For this reason, an accurate avoiding operation can be realized regardless of the skill of the driver.
(第4実施形態)
次に、第4実施形態について図面を参照しつつ説明する。なお、上記各実施形態と同様な構成等については同一の符号を付して説明する。
(構成)
本実施形態の車両構成は、上記第2実施形態(図9)と同様である。すなわち、回避余裕が小さくなったところで、操舵アシストトルクを発生させて回避操作を支援する構成とする。また、本実施形態では、回避余裕の評価について、第2実施形態とは異なる評価方法を示す。
(Fourth embodiment)
Next, a fourth embodiment will be described with reference to the drawings. In addition, about the structure similar to each said embodiment, the same code | symbol is attached | subjected and demonstrated.
(Constitution)
The vehicle configuration of this embodiment is the same as that of the second embodiment (FIG. 9). That is, when the avoidance margin becomes small, the steering assist torque is generated to assist the avoidance operation. In this embodiment, an evaluation method different from that of the second embodiment is shown for evaluation of the avoidance margin.
次に、本実施形態に係る回避支援コントローラ6の処理について、図13を参照しつつ説明する。
ステップS4300では、これ以前の制御サイクルにおいて障害物SMを検出し、回避可能集合(詳細は後述)を生成しているか否かを判定する。生成していると判定した場合には、ステップS4500に移行する。一方、回避可能集合を生成していないと判定した場合には、ステップS4400に移行する。
ステップS4400では、回避可能集合の生成を行い、ステップS4500に移行する。回避可能集合の生成については、後述する。
ステップS4500では、回避可能集合を用いた回避余裕の評価を行う。すなわち、ステップS4400で算出した回避可能集合と、現在の車両状態に基づいて回避余裕を表す指標の算出を行う。ここでは、第iステップに相当する時刻における回避余裕の指標d(i)として、
Next, processing of the
In step S4300, the obstacle SM is detected in the previous control cycle, and it is determined whether or not an avoidable set (details will be described later) is generated. If it is determined that it has been generated, the process proceeds to step S4500. On the other hand, if it is determined that an avoidable set has not been generated, the process moves to step S4400.
In step S4400, an avoidable set is generated, and the process proceeds to step S4500. The generation of the avoidable set will be described later.
In step S4500, the avoidance margin is evaluated using the avoidable set. That is, the avoidable set calculated in step S4400 and the index representing the avoidance margin are calculated based on the current vehicle state. Here, as an index d (i) of the avoidance margin at the time corresponding to the i-th step,
d(i)は、2つの基準解の車両軌跡のうち、より近い軌跡との横方向距離を基準解の車両軌跡で定義される許容幅の大きさで正規化した値である。そして、d(i)の値は、小さいほど回避余裕がない状態に対応している。なお、d(i)の値が負の値の場合には、基準解の車両軌跡で挟まれた領域からの逸脱を意味している。
これに基づき、第2実施形態と同様に、d(i)の値と適当な同値を比較することで回避制御の起動判定を行う。なお、ステップ数iは、評価に用いる回避可能集合を算出した時刻を1とした場合の現在時刻のステップ数を用いる。
d (i) is a value obtained by normalizing the lateral distance from the closer locus of the two reference solution vehicle tracks with the size of the allowable width defined by the reference solution vehicle track. The value of d (i) corresponds to a state where there is no avoidance margin as the value is smaller. In addition, when the value of d (i) is a negative value, it means deviation from the region sandwiched between the vehicle tracks of the reference solution.
Based on this, similarly to the second embodiment, the avoidance control activation determination is performed by comparing the value of d (i) with an appropriate value. The number of steps i uses the number of steps at the current time when the time when the avoidable set used for evaluation is calculated is 1.
続いて、ステップS4600では、実際に算出した指標d(i)に基づいて、回避支援の必要性を判定する。回避支援が必要であると判定した場合には、ステップS4700に移行する。一方、回避支援が不要と判定した場合には、そのまま処理を終了して復帰する。
ステップS4700では、転舵アシストトルクを作用させるための指令値を出力する。転舵アシストトルクとしては、2つの基準解の車両軌跡のうち、自車両SWに近い方の軌跡から遠ざける方向に加わるトルクとし、その大きさを、d(i)が小さいほど、大きくなるような指令値とする。その後、処理を終了して復帰する。
In step S4600, the necessity of avoidance support is determined based on the actually calculated index d (i). If it is determined that avoidance support is necessary, the process moves to step S4700. On the other hand, if it is determined that avoidance support is not necessary, the processing is terminated and returned.
In step S4700, a command value for applying the steering assist torque is output. As the steering assist torque, the torque applied in the direction away from the trajectory closer to the host vehicle SW out of the two trajectories of the reference solution, and the magnitude thereof increases as d (i) decreases. Use command value. Thereafter, the process is terminated and the process returns.
次に、上記ステップS4400の回避可能集合生成処理について、図14を参照しつつ説明する。
ステップS4410及びS4420では、走行可能領域Pの構成を求め、さらに回避可能操作量集合を算出する。この処理は、第2実施形態における、ステップS1300及びS1400と同じ処理である。
次に、ステップS4300では、基準解の算出を行う。
ここで、第2実施形態では、基準解として、(19)式のように操作量の大きさが小さい解、あるいは(20)式及び(21)式のように運転者が取ると予想される操作量に対する補正量の大きさが小さい解を構成している。
これに対して、第4実施形態では、次の2つを基準解として算出する。
a:なるべく障害物SMと接近しつつ接触せずに通過する解
b:なるべく道路境界と接近しつつ路外逸脱せずに通過する解
具体的には、(18)式で定義できる回避可能操作量集合S上で、
Next, the avoidable set generation process in step S4400 will be described with reference to FIG.
In steps S4410 and S4420, the configuration of the travelable area P is obtained, and an avoidable operation amount set is further calculated. This process is the same process as steps S1300 and S1400 in the second embodiment.
Next, in step S4300, a reference solution is calculated.
Here, in the second embodiment, as a reference solution, a solution with a small amount of operation as in equation (19) or a driver as in equations (20) and (21) is expected. A solution with a small correction amount with respect to the operation amount is configured.
On the other hand, in the fourth embodiment, the following two are calculated as reference solutions.
a: Solution that passes as close as possible to the obstacle SM without contacting b b: Solution that passes as close as possible to the road boundary without departing from the road Specifically, an avoidable operation that can be defined by equation (18) On the quantity set S,
以上がステップS4430の処理である。
ステップS4440では、(3)式〜(8)式、および(39)式を、基準解{T* 1(i)}、{T* 2(i)}で積分して、各基準解に対応する車両横位置座標yの時系列{y* 1(i)}{y* 2(i)}をそれぞれ算出する。
以上のようにして、基準解に対応する車両軌跡を得ることが出来ると、第iステップにおいて、車両の横位置座標は、概ね、
The above is the process of step S4430.
In step S4440, equations (3) to (8) and (39) are integrated with reference solutions {T * 1 (i)} and {T * 2 (i)} to correspond to the respective reference solutions. The time series {y * 1 (i)} {y * 2 (i)} of the vehicle lateral position coordinates to be calculated is calculated.
When the vehicle trajectory corresponding to the reference solution can be obtained as described above, in the i-th step, the lateral coordinate of the vehicle is approximately
例えば、図5の場面において(52)式の条件を図示すると、図15のようになる。ステップS4500では、(52)式で定義する領域を回避可能集合として構成して、復帰する。
For example, the condition of the formula (52) is illustrated in the scene of FIG. 5 as shown in FIG. In step S4500, the area defined by equation (52) is configured as an avoidable set, and the process returns.
(動作)
自車両SWが基準解から算出した回避限界線に近づくと、回避限界線から遠ざけるアシストトルクが作用する。これによって、自車両SWを(52)式で定義できる回避限界集合内に留める操作が容易になり、障害物回避を支援することができる。
なお、障害物SMが移動するなどして回避可能集合を算出した時刻と状況が変化した場合には、図13のステップS4300において回避可能集合を既に算出している場合でも、新たな回避可能集合を算出するためにステップS4400に移行するという構成としても良い。
(Operation)
When the host vehicle SW approaches the avoidance limit line calculated from the reference solution, assist torque that moves away from the avoidance limit line acts. This facilitates the operation of keeping the host vehicle SW within the avoidance limit set that can be defined by the equation (52), and can support obstacle avoidance.
When the time and situation when the avoidable set is calculated due to the movement of the obstacle SM or the like changes, even if the avoidable set has already been calculated in step S4300 in FIG. It may be configured to shift to step S4400 in order to calculate.
(本実施形態の効果)
(1)上記各実施形態の効果に加えて、以下の効果を有する。
(2)上記回避支援手段は、自車両状態が回避可能集合の内部に留まる方向に車輪の転舵角を制御する。すなわち、転舵角をシステム側で制御する。この結果、運転者の操舵操作が不十分な場合にそれを補うことができるようになり、運転者の回避能力を高めることができる。
(Effect of this embodiment)
(1) In addition to the effects of the above embodiments, the following effects are obtained.
(2) The avoidance support means controls the turning angle of the wheel in a direction in which the host vehicle state remains inside the avoidable set. That is, the turning angle is controlled on the system side. As a result, when the driver's steering operation is insufficient, it can be compensated, and the driver's avoidance ability can be enhanced.
1 カメラ
2 車速センサ
3 ヨーレートセンサ
4 加速度センサ
5 操舵角センサ
6 回避支援コントローラ
6A センサ信号処理部
6B 回避可能集合算出手段
6Ba 走行可能領域算出手段
6Bb 回避可能操作量集合算出手段
6C 回避支援起動判定手段
6D 回避支援出力手段
7 ブザー
8 ステアリングホイール
10 操舵トルクセンサ
11 転舵角センサ
12 転舵アシストモータ
13 モータコントローラ
21 クラッチ
22 転舵モータ
P 走行可能領域
S 回避可能操作量集合
SM 障害物
SW 自車両
DESCRIPTION OF
Claims (14)
自車両周囲の障害物を検出する障害物検出手段と、
自車両が、所定時間後までの間、障害物と接触することなく走行可能な自車両状態の範囲を回避可能集合として算出する回避可能集合算出手段と、
現在の自車両状態と回避可能集合の境界との関係に基づいて、回避操作支援の必要性の有無を判定する回避支援起動判定手段と、
回避支援起動判定手段の判定結果に基づいて、運転者の回避操作を支援する回避支援手段と、を備えることを特徴とする車両用障害物回避支援装置。 Own vehicle state detection means for detecting the own vehicle state consisting of the movement state and the operation state of the own vehicle;
Obstacle detection means for detecting obstacles around the vehicle;
An avoidable set calculating means for calculating a range of the own vehicle state in which the own vehicle can travel without contacting an obstacle until a predetermined time later, as an avoidable set;
Avoidance support activation determining means for determining the necessity of avoidance operation support based on the relationship between the current host vehicle state and the boundary of the avoidable set;
An obstacle avoidance support apparatus for a vehicle, comprising: avoidance support means for supporting a driver's avoidance operation based on a determination result of the avoidance support activation determination means.
上記回避可能集合算出手段は、検出した道路境界に基づき、自車両が道路境界内に留まりながら障害物と接触することなく走行し得る回避可能集合を算出することを特徴とする請求項1に記載した車両用障害物回避支援装置。 Road boundary detection means for detecting the road boundary ahead of the vehicle,
2. The avoidable set calculating means calculates an avoidable set that allows the vehicle to travel without contacting an obstacle while staying within the road boundary based on the detected road boundary. Obstacle avoidance support device for vehicles.
道路境界の内部を構成する平面領域から障害物の占有領域を除いた領域を走行可能領域として算出する走行可能領域算出手段と、
自車両が、所定時間後までにわたって走行可能領域に留まることが可能な車両操作量の時系列を構成要素とする回避可能操作量集合を算出する回避可能操作量集合算出手段と、
を備えることを特徴とする請求項1又は請求項2に記載した車両用障害物回避支援装置。 The avoidable set calculation means is:
A travelable area calculation means for calculating an area obtained by removing an area occupied by an obstacle from a planar area constituting the inside of a road boundary as a travelable area;
An avoidable operation amount set calculating means for calculating an avoidable operation amount set whose constituent element is a time series of vehicle operation amounts that allows the host vehicle to stay in the driveable region until after a predetermined time;
The obstacle avoidance assistance device for vehicles according to claim 1 or 2 characterized by things.
運転者が取り得る車両操作量の限界を推定する操作限界推定手段を備え、操作限界推定手段が推定した車両操作限界を満たす範囲内に回避可能操作量集合を構成することを特徴とする請求項3に記載した車両用障害物回避支援装置。 The avoidable manipulated variable set calculating means includes:
An operation limit estimation unit that estimates a limit of a vehicle operation amount that a driver can take is provided, and the avoidable operation amount set is configured within a range that satisfies the vehicle operation limit estimated by the operation limit estimation unit. 3. The obstacle avoidance assistance device for a vehicle described in 3.
自車両の車両運動状態の限界を推定する車両運動限界推定手段を備え、車両運動限界推定手段が推定した車両運動限界を満たす範囲内に回避可能操作量集合を構成することを特徴とする請求項3又は請求項4に記載した車両用障害物回避支援装置。 The avoidable manipulated variable set calculating means includes:
The vehicle motion limit estimation means for estimating the limit of the vehicle motion state of the host vehicle is provided, and the avoidable manipulated variable set is configured within a range satisfying the vehicle motion limit estimated by the vehicle motion limit estimation means. The obstacle avoidance assistance device for a vehicle according to claim 3 or claim 4.
上記回避可能操作量集合算出手段は、障害物挙動予測手段が予測した障害物の移動経路に基づく障害物の占有領域の変動を考慮して、回避可能操作量集合を算出することを特徴とする請求項3〜請求項5のいずれか1項に記載した車両用障害物回避支援装置。 Equipped with obstacle behavior prediction means to predict the movement path of obstacles,
The avoidable manipulated variable set calculating means calculates the avoidable manipulated variable set in consideration of the change in the occupied area of the obstacle based on the obstacle movement route predicted by the obstacle behavior predicting means. The vehicle obstacle avoidance assistance device according to any one of claims 3 to 5.
新たな自車両状態または障害物情報を検出するごとに、最新の検出値に基づいて回避可能集合を更新することを特徴とする請求項1〜請求項6のいずれか1項に記載した車両用障害物回避支援装置。 The avoidable set calculation means is:
The vehicle avoidance set according to any one of claims 1 to 6, wherein the avoidable set is updated based on the latest detection value every time a new own vehicle state or obstacle information is detected. Obstacle avoidance support device.
現在の自車両状態と回避可能集合の境界との距離が所定値未満になったと判定すると、回避操作支援が必要であると判定することを特徴とする請求項1〜請求項7のいずれか1項に記載した車両用障害物回避支援装置。 The avoidance support activation determining means is
8. The apparatus according to claim 1, wherein if it is determined that the distance between the current host vehicle state and the boundary of the avoidable set is less than a predetermined value, it is determined that assistance for avoiding operation is necessary. The obstacle avoidance assistance device for vehicles described in the item.
上記回避支援起動判定手段は、運転者操作量予測手段で予測した操作量が回避可能集合から逸脱すると予測した場合に回避操作支援が必要であると判定することを特徴とする請求項1〜請求項8のいずれか1項に記載した車両用障害物回避支援装置。 A driver operation amount prediction means for predicting a driver's future operation amount is provided,
The avoidance support activation determining means determines that avoidance operation support is necessary when the operation amount predicted by the driver operation amount prediction means is predicted to deviate from the avoidable set. Item 9. The obstacle avoidance assistance device for vehicle according to any one of items 8 to 9.
運転者の注意を喚起する警報手段を備え、
上記警報手段を介して警報を行うことで、運転者の回避操作を支援するために運転者に働きかけを行うことを特徴とする請求項1〜請求項9のいずれか1項に記載した車両用障害物回避支援装置。 The avoidance support means is
Equipped with warning means to alert the driver,
The vehicle according to any one of claims 1 to 9, wherein a warning is given through the warning means to act on the driver in order to support the driver's avoidance operation. Obstacle avoidance support device.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008157310A JP5043760B2 (en) | 2008-06-17 | 2008-06-17 | Vehicle obstacle avoidance support apparatus and vehicle obstacle avoidance support method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008157310A JP5043760B2 (en) | 2008-06-17 | 2008-06-17 | Vehicle obstacle avoidance support apparatus and vehicle obstacle avoidance support method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009298355A JP2009298355A (en) | 2009-12-24 |
JP5043760B2 true JP5043760B2 (en) | 2012-10-10 |
Family
ID=41545707
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008157310A Expired - Fee Related JP5043760B2 (en) | 2008-06-17 | 2008-06-17 | Vehicle obstacle avoidance support apparatus and vehicle obstacle avoidance support method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5043760B2 (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9196162B2 (en) | 2011-09-26 | 2015-11-24 | Toyota Jidosha Kabushiki Kaisha | Vehicular driving support system |
JP6206595B2 (en) * | 2014-08-11 | 2017-10-04 | 日産自動車株式会社 | Travel control device and travel control method |
JP6315827B2 (en) * | 2015-03-27 | 2018-04-25 | 国立大学法人名古屋大学 | Driving assistance device |
DE102016109856A1 (en) * | 2016-05-30 | 2017-11-30 | Valeo Schalter Und Sensoren Gmbh | Method for avoiding a collision of a motor vehicle with an object based on a maximum predefinable wheel steering angle, driver assistance system and motor vehicle |
-
2008
- 2008-06-17 JP JP2008157310A patent/JP5043760B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2009298355A (en) | 2009-12-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5272448B2 (en) | Vehicle driving support apparatus and vehicle driving support method | |
JP5130638B2 (en) | Avoidance operation calculation device, avoidance control device, vehicle including each device, avoidance operation calculation method, and avoidance control method | |
JP5098584B2 (en) | Vehicle driving support device | |
CN106061814B (en) | Advance alarm to the steering torque limit more than LCC | |
JP5023869B2 (en) | VEHICLE DRIVE OPERATION SUPPORT DEVICE AND VEHICLE DRIVE OPERATION SUPPORT METHOD | |
JP6515823B2 (en) | Lane change support device | |
KR101516439B1 (en) | Vehicle Driving Assistance | |
CN110626334A (en) | System and method for controlling a vehicle based on expected lane departure | |
JP5206452B2 (en) | Vehicle travel support device and vehicle travel support method | |
JP5205997B2 (en) | Driving operation support device for vehicle | |
US20130043989A1 (en) | Method for Supporting the Driver of a Vehicle | |
JP4811075B2 (en) | Avoidance operation calculation device, avoidance control device, vehicle including each device, avoidance operation calculation method, and avoidance control method | |
JP5412985B2 (en) | Vehicle travel support device | |
JP2009020854A (en) | Lane departure warning system | |
JP5262816B2 (en) | Vehicle travel control device and control method for vehicle travel control device | |
JP4853068B2 (en) | Vehicle support control device | |
JP5624282B2 (en) | Vehicle driving support apparatus and vehicle driving support method | |
JP5315798B2 (en) | Vehicle driving support apparatus and vehicle driving support method | |
CN108016431B (en) | Steering capability prediction | |
JP5043760B2 (en) | Vehicle obstacle avoidance support apparatus and vehicle obstacle avoidance support method | |
JP5359289B2 (en) | Vehicle driving support device | |
US20230150532A1 (en) | Vehicle path adjustment | |
JP7135978B2 (en) | Arithmetic unit for automobile | |
JP6317972B2 (en) | Vehicle lane departure prevention control device | |
JP4961880B2 (en) | Vehicle route calculation apparatus and vehicle route calculation method |
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: 20110315 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20120524 |
|
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: 20120619 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120712 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150720 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |