JP2011245983A - Narrow road running support device, and narrow road running support method - Google Patents
Narrow road running support device, and narrow road running support method Download PDFInfo
- Publication number
- JP2011245983A JP2011245983A JP2010121319A JP2010121319A JP2011245983A JP 2011245983 A JP2011245983 A JP 2011245983A JP 2010121319 A JP2010121319 A JP 2010121319A JP 2010121319 A JP2010121319 A JP 2010121319A JP 2011245983 A JP2011245983 A JP 2011245983A
- Authority
- JP
- Japan
- Prior art keywords
- road
- distance
- threshold value
- threshold
- left turn
- 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.)
- Granted
Links
Images
Abstract
Description
本発明は、狭路走行支援装置、狭路走行支援方法に関するものである。 The present invention relates to a narrow road driving support device and a narrow road driving support method.
自車両が右左折をするときに、内輪差を含めた走行軌跡をシミュレートし、旋回内側に存在する障害物や路肩と接触するか否かを判断し、接触の可能性があるときに、表示装置によって運転者に警告を発するものがあった(特許文献1参照)。 When the host vehicle makes a right or left turn, it simulates the traveling trajectory including the inner wheel difference, determines whether it touches an obstacle or a road shoulder that exists inside the turn, and when there is a possibility of contact, Some display devices give a warning to the driver (see Patent Document 1).
しかしながら、自車両の接触の可能性があることを表示装置で警告するだけでは、操作方向、操作量、操作タイミングなどを含め、どのようなステアリング操作が必要なのかが運転者には分りにくい。
本発明の課題は、狭路にて右左折をする際に、運転者に対して適切なステアリング操作を直感的に促すことである。
However, it is difficult for the driver to know what kind of steering operation is required, including the operation direction, the operation amount, the operation timing, and the like only by warning the display device that there is a possibility of contact with the host vehicle.
An object of the present invention is to intuitively prompt a driver to perform an appropriate steering operation when making a right or left turn on a narrow road.
本発明に係る狭路走行支援装置は、運転者のステアリング操作に対して支援トルクを付与可能とし、自車から左右の走路境界までの距離、及び自車進路前方の右左折路までの距離に応じて、第一の閾値と、この第一の閾値よりも小さな第二の閾値とを設定する。そして、走路境界までの距離が第一の閾値よりも短いときには、支援トルクに対して制御介入し、走路境界への接近を抑制するための回避操作を運転者に促す。一方、走路境界までの距離が第二の閾値よりも短いときには、支援トルクに対して制御介入し、走路境界からの離間を促進するための回避操作を運転者に促す。 The narrow road driving support device according to the present invention is capable of applying a support torque to the steering operation of the driver, and is a distance from the own vehicle to the left and right road boundary and a distance from the left and right turn road ahead of the own vehicle course. In response, a first threshold value and a second threshold value smaller than the first threshold value are set. When the distance to the road boundary is shorter than the first threshold value, control intervention is performed on the assist torque, and the driver is prompted to perform an avoidance operation to suppress the approach to the road boundary. On the other hand, when the distance to the road boundary is shorter than the second threshold, control intervention is performed on the assist torque, and the driver is prompted to perform an avoidance operation to promote separation from the road boundary.
本発明に係る狭路走行支援装置によれば、走路境界までの距離が第一の閾値よりも短いときには、走路境界への接近を抑制するための回避操作を運転者に促し、走路境界までの距離が第二の閾値よりも短いときには、走路境界からの離間を促進するための回避操作を運転者に促すので、狭路にて右左折をする際に、運転者に対して、適切なステアリング操作を直感的に促すことができる。 According to the narrow road driving support device according to the present invention, when the distance to the road boundary is shorter than the first threshold, the driver is prompted to perform an avoidance operation for suppressing the approach to the road boundary, When the distance is shorter than the second threshold value, the driver is encouraged to perform an avoidance operation to promote separation from the road boundary. The operation can be urged intuitively.
以下、本発明の実施形態を図面に基づいて説明する。
《第一実施形態》
《構成》
図1は、操舵支援システムの概略構成図である。
自車10のフロント左側に設けられたソナーセンサ11Lは、自車10の左側に存在する壁やガードレールやフェンス等の側方物体までの距離yLを検出し、検出した距離yLをコントローラ12へ入力する。また、自車10のフロント右側に設けられたソナーセンサ11Rは、自車10の右側に存在する壁やガードレールやフェンス等の側方物体までの距離yRを検出し、検出した距離yRをコントローラ12へ入力する。トルクセンサ14は、ステアリングシャフト15に作用する運転者の操舵トルクTを検出し、検出した操舵トルクTをコントローラ12へ入力する。舵角センサ17は、ステアリングホイール16の操舵角θを検出し、検出した操舵角θをコントローラ12へ入力する。車速センサ18は、自車速Vを検出し、検出した車速Vをコントローラ12へ入力する。ナビゲーションシステム36は、自車の現在位置情報、自車周囲の道路情報、自車の走行ルート情報、及び走行ルートに基づく右左折路と自車の現在位置との距離情報などを含むナビゲーション情報をコントローラ12へ入力する。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
<< First embodiment >>
"Constitution"
FIG. 1 is a schematic configuration diagram of a steering assist system.
A
なお、舵角センサ17は、操舵角θが左旋回領域にあるときに検出値を負値とし、操舵角θが右旋回領域にあるときに検出値を正値として出力する。トルクセンサ14は、操舵トルクTが左旋回方向にあるときに検出値を負値とし、操舵トルクTが右旋回方向にあるときに検出値を正値として出力する。
コントローラ12は、例えばマイクロコンピュータで構成され、入力された各種信号に基づいて電動パワーステアリング用の電動モータ13を駆動制御する。ここでは、電動パワーステアリング装置について説明しているが、ステアリングホイール16と車輪とを機械的に分離可能なステアリングバイワイヤの構成でもよい。また、油圧のパワーステアリング装置において、電動モータを駆動源として油圧制御を行う構成でもよい。
The
The
図2は、モータ制御処理を示すブロック線図である。
コントローラ12は、右左折判断部37と、制御介入判断部19と、助勢トルク指令値演算部20と、狭路支援制御介入部21と、を備える。
右左折判断部37には、ナビゲーションシステム37からのナビゲーション情報が入力される。右左折判断部37では、自車周囲の道路情報に基づいて、自車進路前方の右左折路を検出すると共に、自車の走行ルート情報に基づいて、右左折路で自車が右左折するか否かを判断する。右左折路とは、二本以上の道路が交わる交差点のみならず、一本であっても例えば略直角のように道路曲率の大きいコーナをも含む。
FIG. 2 is a block diagram showing motor control processing.
The
Navigation information from the navigation system 37 is input to the right / left turn determination unit 37. The right / left turn determination unit 37 detects a right / left turn ahead in front of the own vehicle based on road information around the own vehicle, and the vehicle turns right / left on the right / left turn based on the travel route information of the own vehicle. Determine whether or not. The right / left turn road includes not only an intersection where two or more roads intersect but also a corner having a large road curvature such as a substantially right angle even if there is only one.
制御介入判断部19には、ソナー11L及び11Rで検出した側方物体までの距離yL及びyRと、舵角センサ17で検出した操舵角θと、車速センサ18で検出した車速Vと、右左折判断部37の判断結果と、が入力される。制御介入判断部19は、入力した各種信号に基づいて、側方物体から離れる方向のステアリング操作を運転者に促すための狭路支援制御を開始するか否かを判断する。
The control
助勢トルク指令値演算部20には、トルクセンサ14で検出した操舵トルクTと、車速センサ18で検出した車速Vと、が入力される。助勢トルク指令値演算部20は、一般的な電動パワーステアリング装置と同様の演算を行い、入力した各種信号に基づいて、通常のEPSアシストトルクを実現するための電流指令値を助勢トルク指令値Isとして演算する。
The steering torque T detected by the
狭路支援制御介入部21には、右左折判断部37の判断結果と、制御介入判断部19の判断結果と、助勢トルク指令値演算部20の演算結果と、ソナー11L及び11Rで検出した側方物体までの距離yL及びyRと、舵角センサ17で検出した操舵角θと、が入力される。狭路支援制御介入部21は、入力した各種信号に基づいて、電動モータ13に対する最終的な電流指令値を最終トルク指令値Ifとして演算し、演算した最終トルク指令値Ifに応じて電動モータ13を駆動制御する。
The narrow road support
図3は、モータ制御処理を示すフローチャートである。
コントローラ12は、所定の演算周期毎にモータ制御処理を実行する。
先ずステップS101では、各種信号を読込み、メモリ内に保持する。
続くステップS102では、助勢トルク指令値演算部20によって助勢トルク指令値演算処理を実行し、操舵トルクT及び車速Vに応じた通常のEPSアシストトルクを実現するための助勢トルク指令値Isを演算する。
FIG. 3 is a flowchart showing the motor control process.
The
First, in step S101, various signals are read and stored in the memory.
In the subsequent step S102, the assist torque command
続くステップS103では、右左折判断部37により、自車進路前方の右左折路を自車が右左折するか否かを判断する。具体的には、自車の走行ルート情報に応じて判断する。このとき、走行ルート情報のみならず、ウィンカの作動状況を併せて判断してもよい。判断結果は、右左折フラグftとして設定される。すなわち、自車進路前方を左折すると判断したときには、右左折フラグが『ft=−1』にセットされる。また、自車進路前方を右折すると判断したときには、右左折フラグが『ft=1』にセットされる。また、自車進路前方を左折も右折もしないと判断したときには、右左折フラグが『ft=0』にリセットされる。 In subsequent step S103, the right / left turn determination unit 37 determines whether or not the own vehicle turns right or left on the right / left turn road ahead of the own vehicle course. Specifically, the determination is made according to the travel route information of the own vehicle. At this time, not only the travel route information but also the operating status of the winker may be determined together. The determination result is set as a right / left turn flag ft. That is, when it is determined to turn left in front of the host vehicle course, the right / left turn flag is set to “ft = −1”. When it is determined that the vehicle will turn right in front of the vehicle course, the right / left turn flag is set to “ft = 1”. Further, when it is determined that the vehicle does not turn left or right in front of the vehicle course, the right / left turn flag is reset to “ft = 0”.
続くステップS104では、制御介入判断部19によって制御介入判断処理を実行し、側方物体から離れる方向のステアリング操作を運転者に促すための狭路支援制御を行うか否かを判断するサブルーチンを実行する。判断結果は、狭路支援フラグfcとして取得する。
続くステップS105では、狭路支援フラグfcの設定状態を判定する。ここで、狭路支援フラグが『fc=1』又は『fc=2』にセットされていれば、狭路支援制御が必要であると判断してステップS106に移行する。一方、狭路支援フラグが『fc=0』にリセットされていれば、狭路支援制御は不要であると判断してステップS107に移行する。
In the subsequent step S104, a control intervention determination process is executed by the control
In a succeeding step S105, the setting state of the narrow road support flag fc is determined. Here, if the narrow road support flag is set to “fc = 1” or “fc = 2”, it is determined that the narrow road support control is necessary, and the process proceeds to step S106. On the other hand, if the narrow road support flag is reset to “fc = 0”, it is determined that the narrow road support control is unnecessary, and the process proceeds to step S107.
ステップS106では、狭路支援制御介入部21によって狭路支援制御介入処理を実行し、側方物体から離れる方向のアシストトルクを実現するための最終トルク指令値Ifを演算してからステップS108に移行する。
ステップS107では、通常の操舵支援としてアシストトルクを実現するための助勢トルク指令値Isを、そのまま最終トルク指令値としてからステップS108に移行する。
In step S106, the narrow road assistance
In step S107, the assist torque command value Is for realizing the assist torque as normal steering assistance is used as it is as the final torque command value, and then the process proceeds to step S108.
ステップS108では、最終トルク指令値Ifに応じて電動モータ13を駆動制御してから所定のメインプログラムに復帰する。
図4は、制御介入判断処理を示すフローチャートである。
コントローラ12は、前述したステップS103のサブルーチンとして、制御介入判断部19により、制御介入判断処理を実行する。
In step S108, the
FIG. 4 is a flowchart showing the control intervention determination process.
The
先ずステップS601では、各種信号を読込む。
続くステップS602では、右左折フラグが『ft=0』にリセットされているか否かを判定する。ここで、右左折フラグが『ft=0』にリセットされていれば、自車は右左折しないと判断してステップS603に移行する。一方、右左折フラグが『ft=−1』又は『ft=1』にセットされていれば、自車が右左折すると判断してステップS604に移行する。
First, in step S601, various signals are read.
In a succeeding step S602, it is determined whether or not the right / left turn flag is reset to “ft = 0”. If the right / left turn flag is reset to “ft = 0”, it is determined that the vehicle does not turn right / left, and the process proceeds to step S603. On the other hand, if the right / left turn flag is set to “ft = −1” or “ft = 1”, it is determined that the vehicle turns right or left, and the process proceeds to step S604.
ステップS603では、狭路支援フラグを『fc=0』にリセットしてから制御介入判断処理を終了する。
ステップS604では、右左折フラグが『ft=−1』にセットされているか否かを判定する。ここで、右左折フラグが『ft=−1』にセットされていれば、自車が左折すると判断してステップS605に移行する。一方、右左折フラグが『ft=1』にセットされていれば、自車が右折すると判断してステップS606に移行する。
In step S603, the control intervention determination process is terminated after the narrow road support flag is reset to “fc = 0”.
In step S604, it is determined whether the right / left turn flag is set to “ft = −1”. Here, if the right / left turn flag is set to “ft = −1”, it is determined that the host vehicle is turning left, and the process proceeds to step S605. On the other hand, if the right / left turn flag is set to “ft = 1”, it is determined that the vehicle turns to the right, and the process proceeds to step S606.
ステップS605では、左側の側方物体までの距離yLを、左折時旋回内側の側方物体までの距離yiとして設定してからステップS607に移行する。
ステップS606では、右側の側方物体までの距離yRを、右折時旋回内側の側方物体までの距離yiとして設定してからステップS607に移行する。
In step S605, the distance y L to the left side object is set as the distance y i to the side object inside the turn at the left turn, and the process proceeds to step S607.
In step S606, the distance y R to the right side object is set as the distance y i to the side object inside the right turn, and then the process proceeds to step S607.
続くステップS607では、右左折フラグの設定状態、側方物体までの距離yL及びyRと、自車の現在位置から右左折路までの距離yTと、車速Vと、操舵角θとに応じて、右左折時旋回内側における側方物体までの距離yiに対する第一の閾値th1を設定する。すなわち、左折の場合には、左側の側方物体までの距離yLに対する左側用の第一の閾値th1Lを設定し、右折の場合には、右側の側方物体までの距離yRに対する右側用の第一の閾値th1Rを設定するが、説明を簡略にするために、単に第一の閾値th1と表記する。この第一の閾値th1は、側方物体への接近を抑制するための第一の狭路支援制御が介入する閾値であり、詳細な説明は後述する。 In subsequent step S607, the setting state of the right turn flag, and the distance y L and y R to the lateral object, and the distance y T to right or left turn path from the current position of the vehicle, and the vehicle speed V, and the θ steering angle Accordingly, a first threshold th1 is set for the distance y i to the side object inside the turn at the time of turning left or right. That is, in the case of a left turn, the first threshold th1 L for the left side with respect to the distance y L to the left side object is set, and in the case of a right turn, the right side with respect to the distance y R to the right side object. The first threshold th1 R is set, but for the sake of simplicity, it is simply expressed as the first threshold th1. The first threshold th1 is a threshold at which the first narrow path assistance control for suppressing the approach to the side object intervenes, and detailed description thereof will be described later.
続くステップS608では、右左折フラグの設定状態、側方物体までの距離yL及びyRと、自車の現在位置から右左折路までの距離yTと、車速Vと、操舵角θとに応じて、右左折時旋回内側における側方物体までの距離yiに対する第二の閾値th2を設定する。すなわち、左折の場合には、左側の側方物体までの距離yLに対する左側用の第二の閾値th2Lを設定し、右折の場合には、右側の側方物体までの距離yRに対する右側用の第二の閾値th2Rを設定するが、説明を簡略にするために、単に第二の閾値th2と表記する。この第二の閾値th2は、第一の閾値th1よりも小さく、側方物体からの離間を促進するための第二の狭路支援制御が介入する閾値である。 In the subsequent step S608, the setting state of the right / left turn flag, the distances y L and y R to the side object, the distance y T from the current position of the vehicle to the right / left turn road, the vehicle speed V, and the steering angle θ are set. Accordingly, a second threshold th2 is set for the distance y i to the side object inside the turn at the time of turning left or right. That is, in the case of a left turn, the second threshold th2 L for the left side with respect to the distance y L to the left side object is set, and in the case of a right turn, the right side with respect to the distance y R to the right side object. The second threshold th2 R is set, but for the sake of simplicity, it is simply expressed as the second threshold th2. The second threshold th2 is smaller than the first threshold th1 and is a threshold at which the second narrow path assistance control for promoting the separation from the side object intervenes.
ここで、第一の閾値th1及び第二の閾値th2について説明する。
先ず、右左折路よりも予め定められた設定距離thfだけ手前の右左折路進入区間32fでは、右左折路までの距離yTが短いほど、右左折時旋回内側における第一の閾値th1及び第二の閾値th2を大きくし、且つ旋回内側における第一の閾値th1及び第二の閾値th2の間隔を小さくする。つまり、自車が右左折路に近づくほど、第一の閾値th1及び第二の閾値th2を大きくすると共に、第一の閾値th1と第二の閾値th2とを近い値にする。
Here, the first threshold th1 and the second threshold th2 will be described.
First, in front of the right or left turn
また、右左折路のコーナ頂点では、第一の閾値th1及び第二の閾値th2の間隔を予め定められた最小値にする。これは0でもよい。
また、右左折路よりも予め定められた設定距離thbだけ先方の、つまり右左折した先の右左折路進出区間32bでは、右左折路との距離yLが離れるほど、右左折時旋回内側における第一の閾値th1及び第二の閾値th2を小さくし、且つ旋回内側における第一の閾値th1及び第二の閾値th2の間隔を大きくする。つまり、自車の右左折が終わりに近づくほど、また右左折路から離れるほど、第一の閾値th1及び第二の閾値th2を小さくすると共に、第一の閾値th1と第二の閾値th2とを離す。すなわち、自車が右左折路に近づく前の状態に戻す。
At the corner apex of the right / left turn road, the interval between the first threshold th1 and the second threshold th2 is set to a predetermined minimum value. This may be zero.
Further, in the right and left
さらに、自車速Vが高いほど、設定距離thf及びthbを長くする。
続くステップS609では、右左折時旋回内側における側方物体までの距離yiが、第一の閾値th1よりも小さいか否かを判定する。この判定結果が『yi<th1』であれば、右左折時旋回内側の側方物体に対する回避操作が必要であると判断してステップS610に移行する。一方、判定結果が『yi≧th1』であれば、右左折時旋回内側の側方物体に対する回避操作は不要であると判断して前記ステップS603に移行する。
Further, the higher the host vehicle speed V, the longer the set distances thf and thb.
In the subsequent step S609, it is determined whether or not the distance y i to the side object on the inside of the turn at the time of turning right or left is smaller than the first threshold th1. If this determination result is “y i <th1”, it is determined that an avoidance operation is required for the side object inside the turn at the time of turning right or left, and the process proceeds to step S610. On the other hand, if the determination result is “y i ≧ th1”, it is determined that the avoidance operation for the side object inside the turn at the time of turning right or left is unnecessary, and the process proceeds to step S603.
ステップS610では、右左折時旋回内側における側方物体までの距離yiが、第二の閾値th2以上であるか否かを判定する。この判定結果が『yi≧th1』であれば、右左折時旋回内側の側方物体からの離間を促進する必要はないと判断してステップS611に移行する。一方、判定結果が『yi<th2』であれば、右左折時旋回内側の側方物体からの離間を促進する必要があると判断してステップS613に移行する。 In step S610, it is determined whether or not the distance y i to the side object inside the turn at the time of turning right or left is equal to or greater than a second threshold th2. If this determination result is “y i ≧ th1”, it is determined that it is not necessary to promote the separation from the side object inside the turn at the time of turning left or right, and the process proceeds to step S611. On the other hand, if the determination result is “y i <th2”, it is determined that it is necessary to promote the separation from the side object inside the turn at the time of turning right and left, and the process proceeds to step S613.
ステップS611では、操舵角θが中立位置よりも右左折時旋回内側領域にあるか否かを判定する。ここで、操舵角θが中立位置よりも右左折時旋回内側領域にあるときには、右左折時旋回内側の側方物体への接近を抑制する必要があると判断してステップS612に移行する。一方、操舵角θが中立位置にある、又は中立位置よりも右左折時旋回外側領域にあるときには、右左折時旋回内側の側方物体への接近を抑制する必要はないと判断して前記ステップS3に移行する。 In step S611, it is determined whether or not the steering angle θ is in the turning inner area when turning right or left with respect to the neutral position. Here, when the steering angle θ is in the turning inner region when turning right or left with respect to the neutral position, it is determined that it is necessary to suppress the approach to the side object inside the turning when turning right or left, and the process proceeds to step S612. On the other hand, when the steering angle θ is in the neutral position or in the outer turning region when turning right or left than the neutral position, it is determined that it is not necessary to suppress the approach to the side object inside the turning when turning right or left. The process proceeds to S3.
ステップS612では、狭路支援フラグを『fc=1』にセットしてから制御介入判断処理を終了する。
一方、ステップS613では、狭路支援フラグを『fc=2』にセットしてから制御介入判断処理を終了する。
In step S612, the control intervention determination process is terminated after the narrow road support flag is set to “fc = 1”.
On the other hand, in step S613, the control intervention determination process ends after the narrow road support flag is set to “fc = 2”.
図5は、狭路支援制御介入処理を示すブロック線図を示す。
狭路支援制御介入部21は、フィードバック偏差演算部22と、回避トルク指令値演算部23と、レートリミッタ24と、助勢トルク指令値補正部25と、加算器26と、を備える。
FIG. 5 is a block diagram showing the narrow road support control intervention process.
The narrow road assistance
フィードバック偏差演算部22には、ソナー11L及び11Rで検出した側方物体までの距離yL及びyRと、制御介入判断部19の判断結果と、が入力される。フィードバック偏差演算部22は、狭路支援フラグが『fc=1』又は『fc=2』にセットされているときに、例えば現在の距離yL及びyRと参照値Cとの偏差をフィードバック偏差eとして演算する。したがって、自車両が側方物体に接近し、現在の距離yL及びyRが参照値Cから離れるときに、フィードバック偏差eが大きくなる。
The feedback
回避トルク指令値演算部23には、フィードバック偏差演算部22の演算結果と、ソナー11L及び11Rで検出した側方物体までの距離yL及びyRと、制御介入判断部19の判断結果と、が入力される。回避トルク指令値演算部23は、例えば比例フィードバック方式により、フィードバック偏差に比例ゲインKを乗算した値を回避トルク指令値Iaとして演算する。回避トルク指令値Iaは、側方物体から離れる方向のトルクとなり、側方物体までの距離が短いほど大きくなる。
The avoidance torque command
レートリミッタ24には、回避トルク指令値演算部23の演算結果と、制御介入判断部19の判断結果と、が入力される。レートリミッタ24は、狭路支援フラグが変化したときや制御モードが変化したときに、回避トルク指令値Iaの急激な変化を防ぐために、変動レートの大きさを制限する。例えばLPF(Low-Pass Filter)により実現してもよいし、現在値と目標値とを滑らかに接続する回避トルク指令値Iaを演算してもよい。
The calculation result of the avoidance torque command
助勢トルク指令値補正部25には、助勢トルク指令値演算部20の演算結果と、舵角センサ17で検出した操舵角θと、制御介入判断部19の判断結果と、が入力される。助勢トルク指令値補正部25は、狭路支援フラグが『fc=0』から『fc=1』又は『fc=2』に変化したときの操舵角θを介入開始操舵角θsとしてメモリに保持し、以後、介入開始操舵角θsよりも側方物体の側に操舵角θが増加するときに、予め定められたマップに応じて助勢トルク指令値Isを減少補正する。具体的には、助勢トルク指令値演算部20で演算した助勢トルク指令値Isに対して、0〜1の範囲の補正係数kを乗算することにより、助勢トルク指令値Isを減少補正する。したがって、狭路支援フラグが『fc=1』又は『fc=2』に変化した後に、運転者が側方物体に接近する側にステアリング操作を行うと、側方物体の側へのアシストトルクが減少することで、側方物体の側へのステアリング操作に対して重みを増加させる。
The assist torque command
加算器26は、レートリミッタ24で処理された回避トルク指令値Iaと、助勢トルク指令値補正部25で補正された助勢トルク指令値Isとを加算して最終トルク指令値Ifを演算する。
The
図6は、狭路支援制御介入処理を示すフローチャートである。
コントローラ12は、前述したステップS105のサブルーチンとして、狭路支援制御介入部21により、狭路支援制御介入処理を実行する。
FIG. 6 is a flowchart showing a narrow road support control intervention process.
The
先ずステップS201では、助勢トルク指令値補正部25によって助勢トルク指令値補正処理を実行し、助勢トルク指令値Isに対して、0〜1の範囲の補正係数kを乗算することにより、助勢トルク指令値Isを減少補正する。
First, in step S201, the assisting torque command
続くステップS202では、狭路支援フラグが『fc=1』にセットされているか否かを判定する。ここで、狭路支援フラグが『fc=1』にセットされていれば、第一の狭路支援制御を行う必要があると判断してステップS203に移行する。一方、狭路支援フラグが『fc=2』にセットされていれば、第二の狭路支援制御を行う必要があると判断してステップS204に移行する。 In a succeeding step S202, it is determined whether or not the narrow road support flag is set to “fc = 1”. If the narrow road support flag is set to “fc = 1”, it is determined that the first narrow road support control needs to be performed, and the process proceeds to step S203. On the other hand, if the narrow road support flag is set to “fc = 2”, it is determined that the second narrow road support control needs to be performed, and the process proceeds to step S204.
ステップS203では、回避トルク指令値Iaを0に設定してからステップS207に移行する。
ステップS204では、フィードバック偏差演算部22によってフィードバック偏差演算処理を実行し、現在の距離yL及びyRと予め設定された参照値Cとの差分をフィードバック偏差eとして演算する。
In step S203, the avoidance torque command value Ia is set to 0, and then the process proceeds to step S207.
At step S204, and executes the feedback deviation calculation processing by the feedback
続くステップS205では、回避トルク指令値演算部23によって回避トルク指令値演算処理を実行し、フィードバック偏差eに比例ゲインKを乗じることで回避トルク指令値Iaを演算する。
続くステップS206では、レートリミッタ24により、狭路支援フラグが変化したときや制御モードが変化したときに、回避トルク指令値Iaの変化レートを制限してからステップS207に移行する。例えば時定数1秒程度のLPFにより行う。
In subsequent step S205, the avoidance torque command
In the subsequent step S206, when the narrow road support flag is changed or the control mode is changed by the
ステップS207では、加算器26により、前記ステップS203で設定した、又は前記ステップS206で処理した回避トルク指令値Iaと、前記ステップS201で補正した助勢トルク指令値Isと、を加算して最終トルク指令値Ifを演算してから狭路支援制御介入処理を終了する。
In step S207, the
図7は、フィードバック偏差演算処理を示すフローチャートである。
コントローラ12は、前述したステップS204のサブルーチンとして、フィードバック偏差演算部22により、フィードバック偏差演算処理を実行する。
先ずステップS301では、予め設定されたデフォルトの参照値Cを読込む。例えば、C=100cm程度である。
FIG. 7 is a flowchart showing feedback deviation calculation processing.
The
First, in step S301, a preset default reference value C is read. For example, C = about 100 cm.
続くステップS302では、下記(1)式に示すように、参照値Cと、左右のうち選択された何れか一方の側方物体までの距離y1との差分によって、フィードバック偏差eを演算する。ここで、y1は左右両側の側方物体までの距離yL及びyRのうち、回避対象となっている側の距離である。
e=C−y1 …………(1)
In step S302, as shown in the following equation (1), the reference value C, the difference between the distance y 1 to one of the lateral object which is selected among the right and left, and calculates the feedback error e. Here, y 1 is the distance on the side to be avoided among the distances y L and y R to the left and right side objects.
e = C-y 1 (1)
図8は、回避トルク指令値演算処理を示すフローチャートである。
コントローラ12は、前述したステップS202のサブルーチンとして、回避トルク指令値演算部23により、回避トルク指令値演算処理を実行する。
先ずステップS401では、予め設定されたデフォルトのゲインKdを読込む。
続くステップS402では、フィードバック偏差eにゲインKdを乗算した値を回避トルク指令値Iaとして演算してから、回避トルク指令値演算処理を終了する。
FIG. 8 is a flowchart showing avoidance torque command value calculation processing.
The
First, in step S401, a preset default gain Kd is read.
In the subsequent step S402, a value obtained by multiplying the feedback deviation e by the gain Kd is calculated as the avoidance torque command value Ia, and then the avoidance torque command value calculation process is terminated.
なお、P制御を用いているが、回避トルク指令値Iaの演算は他の如何なるフィードバックコントローラを使用してもよく、例えばPID制御を用いてもよいし、最適制御のようなモデルを用いたコントローラ設計を行ってもよい。 Although P control is used, any other feedback controller may be used to calculate the avoidance torque command value Ia. For example, PID control may be used, or a controller using a model such as optimal control. Design may be performed.
図9は、助勢トルク指令値補正処理を示すフローチャートである。
コントローラ12は、前述したS204のサブルーチンとして、助勢トルク指令値補正部25により、助勢トルク指令値補正処理を実行する。
FIG. 9 is a flowchart showing assist torque command value correction processing.
The
先ずステップS501では、現在の操舵角θを読込む。
続くステップS502では、狭路支援フラグが『fc=0』から『fc=1』又は『fc=2』に変化したか否かを判定する。ここで、狭路支援フラグが『fc=1』又は『fc=2』に変化した直後であれば、ステップS503に移行する。一方、狭路支援フラグが『fc=1』に変化した直後でなければステップS504に移行する。
First, in step S501, the current steering angle θ is read.
In the subsequent step S502, it is determined whether or not the narrow road support flag has changed from “fc = 0” to “fc = 1” or “fc = 2”. If the narrow road support flag has just changed to “fc = 1” or “fc = 2”, the process proceeds to step S503. On the other hand, if the narrow road support flag is not immediately after “fc = 1”, the process proceeds to step S504.
ステップS503では、現在の操舵角θを介入開始操舵角θsとしてメモリに保持する。
続くステップS504では、操舵トルクTの方向が、回避対象となっている側方物体の側と一致しているか否かを判定する。すなわち、回避対象となっている側方物体が左側の側方物体であれば、操舵トルクTが左旋回方向に相当する負値であるか否かを判定し、回避対象となっている側方物体が右側の側方物体であれば、操舵トルクTが右旋回方向に相当する正値であるか否かを判定する。ここで、操舵トルクTが回避対象に向いていれば、助勢トルク指令値Isを減少補正する必要があると判断してステップS505に移行する。一方、操舵トルクTが回避対象に向いていなければ、助勢トルク指令値Isを減少補正する必要はないと判断してステップS507に移行する。
In step S503, the current steering angle θ is held in the memory as the intervention start steering angle θs.
In a succeeding step S504, it is determined whether or not the direction of the steering torque T is coincident with the side of the side object to be avoided. That is, if the side object to be avoided is the left side object, it is determined whether or not the steering torque T is a negative value corresponding to the left turning direction, and the side object to be avoided is determined. If the object is a right side object, it is determined whether or not the steering torque T is a positive value corresponding to the right turn direction. Here, if the steering torque T is suitable for avoidance, it is determined that the assist torque command value Is needs to be corrected to decrease, and the process proceeds to step S505. On the other hand, if the steering torque T is not suitable for avoidance, it is determined that the assist torque command value Is does not need to be corrected to decrease, and the process proceeds to step S507.
続くステップS505では、図10のマップを参照し、現在の操舵角θと介入開始操舵角θsとの差分Δθに応じて補正係数kを算出する。
図10は、補正係数kの算出に用いるマップである。
In the subsequent step S505, the correction coefficient k is calculated according to the difference Δθ between the current steering angle θ and the intervention start steering angle θs with reference to the map of FIG.
FIG. 10 is a map used for calculating the correction coefficient k.
差分Δθは、回避対象となっている側方物体が左側の側方物体であれば、操舵角θから介入開始操舵角θsを減算して算出され、回避対象となっている側方物体が右側の側方物体であれば、介入開始操舵角θsから操舵角θを減算して算出される。すなわち、差分Δθが負値となるときには、狭路支援制御を開始した時点よりも回避対象の側にステアリング操作されていることを表し、差分Δθが正値となるときには、狭路支援制御を開始した時点よりも回避対象の反対側にステアリング操作されていることを表す。 The difference Δθ is calculated by subtracting the intervention start steering angle θs from the steering angle θ if the side object to be avoided is the left side object, and the side object to be avoided is the right side. Is calculated by subtracting the steering angle θ from the intervention start steering angle θs. That is, when the difference Δθ is a negative value, it indicates that the steering operation is being performed on the side to be avoided from the time when the narrow road support control is started, and when the difference Δθ is a positive value, the narrow road support control is started. This indicates that the steering operation is performed on the opposite side of the avoidance target from the point of time.
差分Δθが0以上の領域にあるときには、補正係数kは1を維持し、0より小さくなるほど、特性線L1に示すように、補正係数kが1から0の範囲で減少する。また、特性線L2やL3に示すように、車速Vが高いほど、側方物体までの距離の減少化率が高いほど、且つ側方物体までの距離が短いほど、差分Δθの減少に対する補正係数kの減少率が高くなるように設定する。他にも、補正係数kを1から減少させ始める操舵角を、介入開始操舵角θsよりも回避対象の反対側に設定してもよい。また、特性線L1〜L3を任意の形状に設定してもよい。
When the difference Δθ is in the region of 0 or more, the correction coefficient k remains 1, and the correction coefficient k decreases in the range of 1 to 0 as shown by the
続くステップS506では、下記(5)式に示すように、助勢トルク指令値Isに補正係数kを乗算することにより、助勢トルク指令値Isを補正してから助勢トルク指令値補正処理を終了する。
Is ← Is×k …………(5)
In subsequent step S506, as shown in the following equation (5), the assisting torque command value Is is corrected by multiplying the assisting torque command value Is by the correction coefficient k, and then the assisting torque command value correcting process is terminated.
Is ← Is × k ............ (5)
ステップS507では、下記(6)式に示すように、補正係数kを1に設定してから前記ステップS506に移行する。
k=1 …………(6)
In step S507, as shown in the following equation (6), the correction coefficient k is set to 1, and then the process proceeds to step S506.
k = 1 ............ (6)
《作用》
先ず、運転者のステアリング操作に対する助勢トルク指令値Isを演算し(S102)、この助勢トルク指令値Isを最終トルク指令値Ifとして電動モータ13を駆動制御する(S106、S107)。助勢トルク指令値Isは、運転者の操舵方向と同一の支援トルクとなるので、運転者の操舵負担が軽減される。
<Action>
First, an assist torque command value Is for the driver's steering operation is calculated (S102), and the
ところで、幅の狭い右左折路で右左折する(曲がる)際、運転者のステアリング操作が適切でないと、自車両が左右の側方物体に接触してしまう可能性がある。 By the way, when making a right / left turn (turn) on a narrow right / left turn road, if the driver's steering operation is not appropriate, the vehicle may come into contact with the left and right side objects.
図11は、走行シーンの一例を示した図である。
自車両は、左側の走路境界30と、右側の走路境界31とに挟まれた狭路を走行しており、その前方には、直進する進路と略直角に左折する進路とに分岐した分岐点(右左折路)32がある。ここで、分岐点32よりも手前の領域を分岐点進入区間32fとし、32で左折した先方の領域を分岐点進出区間32bとし、分岐点進入区間32fを通過中の自車位置を10a、分岐点を通過中の自車位置を10b、分岐点進出区間32bを通過中の自車位置を10cで表している。分岐点32で左折した先の道路は、左側の走路境界33と、右側の走路境界34とに挟まれた狭路である。さらに、分岐点進出区間32bの左側の走路境界33の基端部、つまり分岐点進入区間32fの左側の走路境界30と、分岐点進出区間32bの左側の走路境界33と、が交わる部位を角部35とし、分岐点進出区間32bの右側の走路境界34の基端部を角部36とする。ここで、走路境界30、31、33、34は、例えば壁やガードレールやフェンス等の側方物体を想定している。
FIG. 11 is a diagram illustrating an example of a traveling scene.
The host vehicle travels on a narrow road sandwiched between the
このような狭路を走行する場合、分岐点32を左折する際に、内輪差によって左折時旋回内側の角部35に車体側面を接触させてしまう可能性がある。そこで、この角部35との接触を回避するための適切なステアリング操作を直感的に促すために、電動モータ13の支援トルクに対して制御介入し、操舵支援を行う。
When traveling on such a narrow road, when turning left at the
先ず、自車進路前方の分岐点32で自車が左折するか否かを判断する(S103)。このとき、自車の走行ルート情報が左折を示していたり、ウィンカが左折指示状態に操作されていたりするときに、自車が分岐点32で左折すると判断し、右左折フラグが『ft=−1』にセットされる。
First, it is determined whether or not the vehicle turns left at a
そして、ソナー11L及び11Rによって、走路境界との距離yL及びyRを検出し、検出結果に応じて狭路支援制御の介入が必要か否かを判断する(S104)。
ここでは、先ず左側の距離yLを左折時旋回内側の側方物体までの距離yiとし(S604、S605)、この左折時旋回内側の距離yiに対して、第一の閾値th1及び第二の閾値th2を設定する(S607、S608)。そして、左側の距離yiが第一の閾値th1より小さく(S609の判定が“Yes”)、第二の閾値th2以上であり(S610の判定が“Yes”)、且つ操舵角θが左旋回領域にあるときに(S611の判定が“Yes”)、角部35を含め左折時旋回内側の走路境界30、33への接近を抑制するために第一の狭路支援制御の介入が必要であると判断する(S612)。但し、操舵角θが中立位置にある、又は中立位置よりも右旋回領域にあるときには(S611の判定が“No”)、左側の側方物体への接近はないので、第一の狭路支援制御の介入は不要であると判断する(S603)。一方、左側の距離yiが第二の閾値th2より小さいときには(S610の判定が“No”)、角部35を含め左折時旋回内側の走路境界30、33からの離間を促進するために第二の狭路支援制御の介入が必要であると判断する(S613)。
Then, the
Here, first the left distance y L is the distance y i to the lateral object left turn at the turning inner (S604, S605), with respect to the distance y i in turning inside the left, the first threshold value th1 and the A second threshold th2 is set (S607, S608). The left-side distance y i is smaller than the first threshold th1 (the determination in S609 is “Yes”), is equal to or greater than the second threshold th2 (the determination in S610 is “Yes”), and the steering angle θ is turned left. When it is in the region (determination in S611 is “Yes”), the first narrow road support control intervention is necessary to suppress the approach to the
ここで、第一の閾値th1及び第二の閾値th2の設定について説明する。
図12は、左折時旋回内側に対する第一の閾値th1及び第二の閾値th2を示す図である。
ここでは、第一の閾値th1及び第二の閾値th2を、便宜上、走路境界30、33からの距離とし、走路境界30、33に沿ったラインとして図示している。通常、左折する際には、自車は内輪差を考慮して僅かに大回りする、つまり角部35との離間方向に僅かに膨らむように通行するので、こうしたステアリング操作を促すための設定を示す。
Here, the setting of the first threshold th1 and the second threshold th2 will be described.
FIG. 12 is a diagram showing a first threshold th1 and a second threshold th2 with respect to the inside when turning left.
Here, for the sake of convenience, the first threshold th1 and the second threshold th2 are distances from the
第一の閾値th1と第二の閾値th2とで囲まれた領域が、走路境界への接近を抑制するために第一の狭路支援制御が介入する領域となり、第二の閾値th2と走路境界30、33とで囲まれた領域が、走路境界からの離間を促進するために第二の狭路支援制御が介入する領域となる。 The area surrounded by the first threshold th1 and the second threshold th2 is an area where the first narrow road support control intervenes to suppress the approach to the road boundary, and the second threshold th2 and the road boundary A region surrounded by 30 and 33 is a region where the second narrow road support control intervenes in order to promote separation from the road boundary.
先ず、分岐点進入区間32fよりも手前では、第一の閾値th1及び第二の閾値th2は略一定であり、第二の閾値th2は第一の閾値th1の半分程度の値である。すなわち、第一の閾値th1及び第二の閾値th2は、走路境界30と略平行なラインとなる。
First, before the branch
次に、分岐点進入区間32fからは、分岐点32に近づくほど、第一の閾値th1及び第二の閾値th2を大きくする。すなわち、第一の閾値th1及び第二の閾値th2は、走路境界30から離間するようなラインとなる。これにより、分岐点32に近づくほど、第一の狭路支援制御が介入する領域と、第二の狭路支援制御が介入する領域とが広くなる。すなわち、左側の距離yiが第一の閾値th1や第二の閾値th2を下回りやすくなり、第一の狭路支援制御や第二の狭路支援制御が介入しやすくなる。
Next, from the branch
また、分岐点32に近づくほど、第一の閾値th1及び第二の閾値th2の間隔を小さくする。すなわち、第一の閾値th1と第二の閾値th2とが接近するようなラインとなる。これにより、分岐点32に近づくほど、第一の狭路支援制御が介入する領域が、第二の狭路支援制御が介入する領域よりも相対的に狭くなる。すなわち、左側の距離yiが第一の閾値th1を下回っても、すぐに第二の閾値th2を下回りやすくなり、第二の狭路支援制御が介入しやすくなる。
Further, the closer to the
したがって、分岐点32に近づく際に、走路境界30からの離間(左折時の膨らみ)が足りないときには、先ず第一の狭路支援制御が作動し、走路境界30への接近が抑制される。それでもなお、角部35との接触の可能性があるときには、次に第二の狭路支援制御が作動し、走路境界30からの離間が促進される。
Therefore, when approaching the
このように、分岐点進入区間32fから第一の閾値th1及び第二の閾値th2のラインが変化し始める。分岐点進入区間32fは、分岐点32からの設定距離thfによって定まり、車速Vが高いほど設定距離thfは長くなる。これは、車速Vが速いほど、走路境界30や角部35への接近が早まり、回避操作を行う余裕が少なくなるからである。
In this manner, the first threshold th1 and second threshold th2 lines start to change from the branch
そして、角部35において、走路境界30から走路境界33までの角度の中間位置(コーナ頂点)では、第一の閾値th1と第二の閾値th2との間隔を最小値とする。すなわち、第一の閾値th1と第二の閾値th2とが最接近するようなラインとなる。これにより、コーナ頂点では、第一の狭路支援制御が介入する領域が、第二の狭路支援制御が介入する領域よりも相対的に狭くなる。すなわち、左側の距離yiが第一の閾値th1を下回っても、すぐに第二の閾値th2を下回りやすくなり、第二の狭路支援制御が介入しやすくなる。
In the
したがって、コーナ頂点では、第一の狭路支援制御よりも主に第二の狭路支援制御が作動し、角部35との接触を回避する適切なステアリング操作を運転者に直感的に促す。
次に、分岐点進出区間32bからは、分岐点32から離れるほど、第一の閾値th1及び第二の閾値th2を小さくする。すなわち、第一の閾値th1及び第二の閾値th2は、走路境界30へと接近するようなラインとなる。これにより、分岐点32から離れるほど、第一の狭路支援制御が介入する領域と、第二の狭路支援制御が介入する領域とが狭くなる。すなわち、左側の距離yiが第一の閾値th1や第二の閾値th2を下回りにくくなり、第一の狭路支援制御や第二の狭路支援制御が介入しにくくなる。
Therefore, at the corner apex, the second narrow road support control is mainly operated rather than the first narrow road support control, and the driver is intuitively prompted to perform an appropriate steering operation to avoid contact with the
Next, from the branch
また、分岐点32から離れるほど、第一の閾値th1及び第二の閾値th2の間隔を大きくする。すなわち、第一の閾値th1と第二の閾値th2とが離間するようなラインとなる。これにより、分岐点32から離れるほど、第一の狭路支援制御が介入する領域の幅が、第二の狭路支援制御が介入する領域の幅に近づいてゆく。すなわち、左側の距離yiが第一の閾値th1を下回っても、すぐに第二の閾値th2を下回ることが起きにくくなり、第一の狭路支援制御が維持されやすくなる。
Further, as the distance from the
したがって、分岐点32から離れる際には、角部35や走路境界33への接触の可能性が低くなるので、第一の閾値th1及び第二の閾値th2が元の状態へと徐々に復帰してゆき、第一の狭路支援制御や第二の狭路支援制御が不必要に介入することが抑制される。勿論、運転者が左折時にステアリングホイール16を左旋回方向に切り過ぎていれば、先ず第一の狭路支援制御が作動し、走路境界33への接近が抑制される。それでもなお、走路境界33との接触の可能性があるときには、次に第二の狭路支援制御が作動し、走路境界33からの離間が促進される。
Therefore, when leaving the
そして、分岐点進出区間32bよりも先方では、第一の閾値th1及び第二の閾値th2は略一定の状態に復帰し、第二の閾値th2は第一の閾値th1の半分程度の値となる。すなわち、第一の閾値th1及び第二の閾値th2は、走路境界30と略平行なラインへと復帰する。
Then, before the branch
このように、分岐点進出区間32bを抜けるまでは、第一の閾値th1及び第二の閾値th2のラインは刻々と変化している。分岐点進出区間32bは、分岐点32からの設定距離thbによって定まり、車速Vが高いほど設定距離thbは長くなる。これは、車速Vが速いほど、角部35や走路境界33への接近が早まり、回避操作を行う余裕が少なくなるからである。
As described above, the lines of the first threshold th1 and the second threshold th2 change every moment until the branch
上記が第一の閾値th1及び第二の閾値th2の設定についての説明である。
こうして、第一の狭路支援制御、又は第二の狭路支援制御の要否を判断し、何れかの制御介入が必要であると判断したら、最終トルク指令値Ifに対して制御介入し、操舵支援を行う(S106)。
The above is an explanation of the setting of the first threshold th1 and the second threshold th2.
Thus, it is determined whether or not the first narrow road assistance control or the second narrow road assistance control is necessary, and if any control intervention is necessary, the control intervention is performed on the final torque command value If, Steering assistance is performed (S106).
ここでは、回避トルク指令値Iaと助勢トルク指令値Isとの加算によって最終トルク指令値Ifを演算する(S207)。回避トルク指令値Iaは、走路境界から離れる方向の支援トルクとなる。一方、助勢トルク指令値Isは、運転者の操舵方向と同一の支援トルクとなるので、運転者の操舵方向が走路境界に向かっていれば、この助勢トルク指令値Isを減少補正することで、左折時旋回内側の走路境界に対する接近が抑制される。つまり、助勢トルクが弱まり、運転者からするとステアリング操作が重くなるので、左折時旋回内側の走路境界に対する接近が抑制される。このように、回避トルク指令値Iaの増加と、助勢トルク指令値Isの減少との組合せによって、最終トルク指令値Ifに対する制御介入を行う。したがって、回避トルク指令値Iaの発生量(0からの増加量)と、運転者の操舵方向が走路境界に向かっているときにおける助勢トルク指令値Isの減少量とが、狭路支援制御による制御介入量となる。 Here, the final torque command value If is calculated by adding the avoidance torque command value Ia and the assisting torque command value Is (S207). The avoidance torque command value Ia is a support torque in a direction away from the road boundary. On the other hand, the assist torque command value Is is the same assist torque as the driver's steering direction. Therefore, if the driver's steering direction is toward the road boundary, the assist torque command value Is is corrected to decrease. Approach to the road boundary inside the turn when turning left is suppressed. That is, the assisting torque is weakened and the steering operation becomes heavy for the driver, so that the approach to the road boundary on the inner side of the turn when turning left is suppressed. Thus, control intervention is performed on the final torque command value If by a combination of an increase in the avoidance torque command value Ia and a decrease in the assist torque command value Is. Therefore, the generation amount of the avoidance torque command value Ia (the increase amount from 0) and the decrease amount of the assist torque command value Is when the driver's steering direction is toward the road boundary are controlled by the narrow road support control. The amount of intervention.
ここで、第一の狭路支援制御、及び第二の狭路支援制御について説明する。
先ず、第一の狭路支援制御では、単に走路境界への接近を抑制するだけなので、回避トルク指令値Iaは0とし(S203)、助勢トルク指令値Isの減少補正のみを行う。
助勢トルク指令値Isは、補正係数kの乗算によって演算される(S506)。
Here, the first narrow road support control and the second narrow road support control will be described.
First, in the first narrow road support control, the approach torque command value Ia is set to 0 (S203) because only the approach to the road boundary is suppressed, and only the reduction correction of the assist torque command value Is is performed.
The assist torque command value Is is calculated by multiplying the correction coefficient k (S506).
ここで、狭路支援フラグが『fc=0』から『fc=1』に変化したときの操舵角θを、介入開始操舵角θsとして設定し(S502、S503)、それ以降は、現在の操舵角θと介入開始操舵角θsとの差分Δθに応じて補正係数kを算出する(S505)。これにより、第一の狭路支援制御を開始してから、運転者が更に回避対象の側へとステアリング操作するほど、補正係数kが1から0の範囲で減少するので、助勢トルク指令値Isが減少補正される。 Here, the steering angle θ when the narrow road support flag changes from “fc = 0” to “fc = 1” is set as the intervention start steering angle θs (S502, S503). The correction coefficient k is calculated according to the difference Δθ between the angle θ and the intervention start steering angle θs (S505). As a result, the correction coefficient k decreases in the range of 1 to 0 as the driver further performs the steering operation toward the avoidance target side after the first narrow road assist control is started, so that the assist torque command value Is Is corrected to decrease.
例えば、左側の走路境界30が回避対象にとされ、操舵角θが左旋回方向となる−5°のときに、制御介入が開始された場合には、その後は、操舵角θが−5°未満となるときに、差分Δθが0未満の領域となるので、補正係数kが1から0の範囲で減少する。この補正係数kを助勢トルク指令値Isに乗算するので、左旋回方向への助勢トルク指令値Isが減少補正され、左旋回方向へのステアリング操作が重くなり、左側の走路境界30への接近が抑制される。一方、制御介入してからの操舵角θが−5°以上となるときに、差分Δθが0以上の領域となるので、補正係数kが1を維持する。したがって、助勢トルク指令値Isの補正を中止する。
For example, when the control intervention is started when the
このように、制御介入を開始してからの操舵角θが、介入開始操舵角θsよりも回避対象となる走路境界の側に増加するほど、助勢トルク指令値Isに対する減少補正量を大きくすることで、より確実に回避操作を促すことができる。
また、車速Vが高いほど、差分Δθの減少に対する補正係数kの減少率を高くする。すなわち、車速Vが高いほど、走路境界への接近速度も早いので、助勢トルク指令値Isに対する減少補正量を大きくする。これにより、より確実に回避操作を促すことができる。
As described above, the reduction correction amount for the assist torque command value Is is increased as the steering angle θ after the start of the control intervention increases to the side of the lane boundary to be avoided from the intervention start steering angle θs. Thus, the avoidance operation can be urged more reliably.
Further, the higher the vehicle speed V, the higher the reduction rate of the correction coefficient k with respect to the reduction of the difference Δθ. That is, the higher the vehicle speed V is, the faster the approach speed to the road boundary is, so the reduction correction amount for the assist torque command value Is is increased. Thereby, the avoidance operation can be urged more reliably.
また、回避対象となる走路境界との距離y1の減少率が高いほど、差分Δθの減少に対する補正係数kの減少率を高くする。すなわち、単位時間当たりの距離y1の減少率が高いほど、走路境界への接近速度も早いので、助勢トルク指令値Isに対する減少補正量を大きくする。これにより、より確実に回避操作を促すことができる。 Further, the higher the decrease rate of the distance y 1 from the road boundary to be avoided, the higher the decrease rate of the correction coefficient k with respect to the decrease of the difference Δθ. That is, the higher the rate of decrease of the distance y 1 per unit time, the faster the approaching speed to the road boundary, so the reduction correction amount for the assist torque command value Is is increased. Thereby, the avoidance operation can be urged more reliably.
また、回避対象となる走路境界との距離y1が短いほど、差分Δθの減少に対する補正係数kの減少率を高くする。すなわち、距離y1が短いほど、助勢トルク指令値Isに対する減少補正量を大きくする。これにより、より確実に回避操作を促すことができる。 Further, the shorter the distance y 1 from the road boundary to be avoided, the higher the reduction rate of the correction coefficient k with respect to the reduction of the difference Δθ. That is, as the distance y 1 is shorter, the decrease correction amount with respect to the assist torque command value Is is increased. Thereby, the avoidance operation can be urged more reliably.
また、運転者の操舵トルクTが、回避対象となる走路境界から離れる側に作用していれば(S504の判定が“No”)、補正係数kの値を1に設定する(S507)。したがって、運転者が回避対象から離れようとステアリング操作を実行すれば、助勢トルク指令値Isの減少補正は中止する。すなわち、回避対象となる走路境界から離れようとするときには、通常の電動パワーステアリング装置と同様に、助勢トルク指令値Isは運転者の操舵方向と同一の支援トルクに戻るので、運転者の操舵負担が軽減され、スムーズな回避操作を実現することができる。 If the driver's steering torque T acts on the side away from the road boundary to be avoided (determination in S504 is “No”), the value of the correction coefficient k is set to 1 (S507). Therefore, if the driver performs a steering operation so as to move away from the avoidance target, the reduction correction of the assist torque command value Is is stopped. That is, when leaving the road boundary to be avoided, the assist torque command value Is returns to the same assist torque as the driver's steering direction, as in the case of a normal electric power steering device. Can be reduced, and a smooth avoidance operation can be realized.
次に、第二の狭路支援制御では、走路境界からの離間を促進する必要があるので、回避トルク指令値Iaの増加と、助勢トルク指令値Isの減少とによって、最終トルク指令値Ifに対する制御介入を行う。 Next, in the second narrow road support control, since it is necessary to promote separation from the road boundary, the increase in the avoidance torque command value Ia and the decrease in the assist torque command value Is result in the final torque command value If being set. Perform control intervention.
このように、回避トルク指令値Iaと助勢トルク指令値Isとの加算によって最終トルク指令値Ifを演算することで、回避対象の側の走路境界に対する接近が抑制されたり、離間が促進されたりする。すなわち、回避トルク指令値Iaと助勢トルク指令値Isとが異なる符号(方向)である場合、回避トルク指令値Iaの絶対値が助勢トルク指令値Isの絶対値よりも小さければ、回避対象の側の走路境界に対する接近が抑制され、回避トルク指令値Iaの絶対値が助勢トルク指令値Isの絶対値よりも大きければ、回避対象の側の走路境界に対する離間が促進される。また、回避トルク指令値Iaと助勢トルク指令値Isとが同じ符号(方向)である場合には、常に回避対象の側の走路境界に対する離間が促進される。 Thus, by calculating the final torque command value If by adding the avoidance torque command value Ia and the assist torque command value Is, approach to the road boundary on the avoidance target side is suppressed or separation is promoted. . That is, when the avoidance torque command value Ia and the assist torque command value Is have different signs (directions), if the absolute value of the avoidance torque command value Ia is smaller than the absolute value of the assist torque command value Is, the avoidance target side If the approach to the road boundary is suppressed and the absolute value of the avoidance torque command value Ia is larger than the absolute value of the assist torque command value Is, the separation from the road boundary on the side to be avoided is promoted. In addition, when the avoidance torque command value Ia and the assist torque command value Is have the same sign (direction), separation from the avoidance target side traveling path boundary is always promoted.
助勢トルク指令値Isの減少については、第一の狭路支援制御と同様である。
また、回避トルク指令値Iaは、フィードバック偏差eとフィードバックゲインKとの乗算によって演算される(S402)。ここでは、前記(1)式により、デフォルトの参照値Cと回避対象の側の距離y1との差分をフィードバック偏差eとして演算する(S302)。これにより、回避対象の側の距離y1が小さいほど、つまり自車量が回避対象に接近するほど、回避トルク指令値Iaが大きくなるので、より確実に回避操作を運転者に促すことができる。
The decrease in the assist torque command value Is is the same as in the first narrow road support control.
The avoidance torque command value Ia is calculated by multiplying the feedback deviation e and the feedback gain K (S402). Here, the difference between the default reference value C and the distance y 1 on the avoidance target side is calculated as the feedback deviation e according to the equation (1) (S302). Accordingly, the avoidance torque command value Ia increases as the distance y 1 on the avoidance target side is smaller, that is, the closer the host vehicle amount is to the avoidance target, and thus the avoidance operation can be urged more reliably to the driver. .
《応用例》
なお、走路境界として、例えば壁やガードレールやフェンス等の側方物体を検出する場合について説明したが、これに限定されるものではなく、路面に標示された通行区分線や、又は側溝などを検出し、これら走路境界までの距離を検出してもよい。
《Application example》
In addition, although the case where side objects, such as a wall, a guardrail, and a fence, were detected as a runway boundary was demonstrated, it is not limited to this, The traffic division line marked on the road surface, or a side ditch etc. is detected. However, the distance to these runway boundaries may be detected.
また、第一の狭路支援制御、及び第二の狭路支援制御では、最終トルク指令値Ifに対して制御介入を行っているが、その旨を音や表示によって運転者に提示してもよい。表示の場合には、現在の車速Vや操舵角θを維持したときの予想進路を、例えばアッカーマン・ジャントウの方程式などに基づいて演算し、その演算結果を提示してもよい。 Further, in the first narrow road assistance control and the second narrow road assistance control, control intervention is performed on the final torque command value If, but even if this is presented to the driver by sound or display. Good. In the case of display, the predicted course when the current vehicle speed V and steering angle θ are maintained may be calculated based on, for example, the Ackermann-Jantou equation, and the calculation result may be presented.
また、右左折時旋回内側の走路境界との距離yiが短いほど、第一の閾値th1及び第二の閾値th2を大きくしてもよい。これにより、走路境界との接触の可能性が高まるほど、第一の狭路支援制御と第二の狭路支援制御とが制御介入しやすくなり、より適切なタイミングで回避操作を運転者に促すことができる。 In addition, the first threshold th1 and the second threshold th2 may be increased as the distance y i to the inner boundary of the turning road when turning right or left is shorter. As a result, as the possibility of contact with the road boundary increases, the first narrow road assistance control and the second narrow road assistance control are more likely to intervene and prompt the driver to perform an avoidance operation at a more appropriate timing. be able to.
また、走路境界に対する車体姿勢を検出し、車体姿勢が右左折時旋回内側の走路境界に向いているほど、第一の閾値th1及び第二の閾値th2を大きくしてもよい。車体姿勢は、例えば車体前方を撮像した画像データに基づいて検出すればよく、この処理が「車体姿勢検出手段」に対応する。これにより、走路境界との接触の可能性が高まるほど、第一の狭路支援制御と第二の狭路支援制御とが制御介入しやすくなり、より適切なタイミングで回避操作を運転者に促すことができる。 Alternatively, the vehicle body posture with respect to the road boundary may be detected, and the first threshold th1 and the second threshold th2 may be increased as the vehicle body posture is directed toward the road boundary on the inner side of the turn when turning right or left. The vehicle body posture may be detected, for example, based on image data obtained by imaging the front of the vehicle body, and this process corresponds to “vehicle body posture detection means”. As a result, as the possibility of contact with the road boundary increases, the first narrow road assistance control and the second narrow road assistance control are more likely to intervene and prompt the driver to perform an avoidance operation at a more appropriate timing. be able to.
また、操舵角を検出し、操舵角θが右左折時旋回内側の走路境界に向いているほど、第一の閾値th1及び第二の閾値th2を大きくしてもよい。これにより、走路境界との接触の可能性が高まるほど、第一の狭路支援制御と第二の狭路支援制御とが制御介入しやすくなり、より適切なタイミングで回避操作を運転者に促すことができる。 Alternatively, the steering angle may be detected, and the first threshold th1 and the second threshold th2 may be increased as the steering angle θ is directed to the running road boundary inside the turn when turning right or left. As a result, as the possibility of contact with the road boundary increases, the first narrow road assistance control and the second narrow road assistance control are more likely to intervene and prompt the driver to perform an avoidance operation at a more appropriate timing. be able to.
《効果》
以上より、電動モータ13、助勢トルク指令値演算部20が「付与手段」に対応し、ソナーセンサ11L及び11Rが「走路境界距離検出手段」に対応し、ステップS103の処理が「右左折判断手段」に対応し、ナビゲーションシステム36が「右左折路距離検出手段」に対応し、ステップS607、S608の処理が「閾値設定手段」に対応し、制御介入判断部19及び狭路支援制御介入部21が「制御介入手段」に対応する。また、車速センサ18が「車速検出手段」に対応し、舵角センサ17が「操舵角検出手段」に対応する。
"effect"
As described above, the
(1)運転者のステアリング操作に対して支援トルクを付与可能な付与手段と、自車から左右の走路境界までの距離を検出する走路境界距離検出手段と、自車進路前方の右左折路で自車が右左折するか否かを判断する右左折判断手段と、前記右左折判断手段で自車が右左折すると判断したときに、自車の現在位置と前記右左折路との距離を検出する右左折路距離検出手段と、前記走路境界距離検出手段で検出した前記走路境界までの距離、及び前記右左折路距離検出手段で検出した前記右左折路との距離に応じて、第一の閾値、及び前記第一の閾値よりも小さな第二の閾値を設定する閾値設定手段と、前記走路境界距離検出手段で検出した前記走路境界までの距離が、前記閾値設定手段で設定した第一の閾値よりも短いときに、前記付与手段の前記支援トルクに対して制御介入することで、前記走路境界への接近を抑制するための回避操作を運転者に促し、前記走路境界距離検出手段で検出した前記走路境界までの距離が、前記閾値設定手段で設定した第二の閾値よりも短いときに、前記付与手段の前記支援トルクに対して制御介入することで、前記走路境界からの離間を促進するための回避操作を運転者に促す制御介入手段と、を備える。 (1) An applying means capable of applying a support torque to the driver's steering operation, a road boundary distance detecting means for detecting a distance from the own vehicle to the left and right road boundaries, and a right / left turn road ahead of the own vehicle Detects the distance between the current position of the vehicle and the right / left turn road when the vehicle determines to turn right / left by the right / left turn determination unit. According to the distance between the right / left turn road distance detecting means, the distance to the road boundary detected by the road boundary distance detecting means, and the distance from the right / left turn road detected by the right / left turn road distance detecting means. Threshold value setting means for setting a threshold value and a second threshold value smaller than the first threshold value, and a distance to the road boundary detected by the road boundary distance detection means is a first threshold value set by the threshold value setting means. When the grant means is shorter than the threshold, By performing control intervention on the assist torque, the driver is prompted to perform an avoidance operation for suppressing the approach to the road boundary, and the distance to the road boundary detected by the road boundary distance detection means is the threshold value. Control that prompts the driver to perform an avoidance operation to promote separation from the road boundary by performing control intervention on the support torque of the applying means when the second threshold value is shorter than the second threshold set by the setting means Intervention means.
このように、走路境界までの距離が第一の閾値よりも短いときには、走路境界への接近を抑制するための回避操作を運転者に促し、走路境界までの距離が第二の閾値よりも短いときには、走路境界からの離間を促進するための回避操作を運転者に促すので、狭路にて右左折をする際に、運転者に対して、適切なステアリング操作を直感的に促すことができる。 Thus, when the distance to the road boundary is shorter than the first threshold, the driver is prompted to perform an avoidance operation for suppressing the approach to the road boundary, and the distance to the road boundary is shorter than the second threshold. Occasionally, the driver is prompted to perform an avoidance operation to promote separation from the road boundary. Therefore, when making a right or left turn on a narrow road, the driver can be intuitively prompted to perform an appropriate steering operation. .
(2)前記閾値設定手段は、前記右左折路よりも予め定められた設定距離だけ手前の進入区間では、前記右左折路距離検出手段で検出した前記右左折路との距離が近いほど、右左折時旋回内側における前記第一の閾値及び第二の閾値を大きくし、且つ右左折時旋回内側における前記第一の閾値及び前記第二の閾値の間隔を小さくする。 (2) In the approach section that is a predetermined set distance ahead of the right / left turn road, the threshold value setting means, the closer the distance to the right / left turn road detected by the right / left turn road distance detection means, The first threshold value and the second threshold value inside the turn at the time of left turn are increased, and the interval between the first threshold value and the second threshold value at the inside of the turn at the time of right turn is reduced.
これにより、第一の狭路支援制御と第二の狭路支援制御とが制御介入しやすくなり、より適切なタイミングで回避操作を運転者に促すことができる。また、第一の狭路支援制御よりも第二の狭路支援制御の重みを相対的に増加させることで、第一の狭路支援制御による煩わしさを軽減することができる。 As a result, the first narrow road assistance control and the second narrow road assistance control can easily intervene, and the driver can be prompted to perform an avoidance operation at a more appropriate timing. Moreover, the troublesomeness by 1st narrow road assistance control can be reduced by making the weight of 2nd narrow road assistance control relatively increase rather than 1st narrow road assistance control.
(3)前記閾値設定手段は、前記右左折路よりも予め定められた設定距離だけ先方の進出区間では、前記右左折路距離検出手段で検出した前記右左折路との距離が離れるほど、右左折時旋回内側における前記第一の閾値及び前記第二の閾値を小さくし、且つ右左折時旋回内側における前記第一の閾値及び前記第二の閾値の間隔を大きくする。 (3) The threshold value setting means, as the distance from the right / left turn road detected by the right / left turn distance detection means increases in the advance section that is a predetermined distance ahead of the right / left turn road, The first threshold value and the second threshold value inside the turn at the time of turning left are reduced, and the interval between the first threshold value and the second threshold value inside the turning at the time of turning right and left is increased.
これにより、第一の狭路支援制御と第二の狭路支援制御とが制御介入しにくくなり、より適切なタイミングで回避操作を運転者に促すことができる。また、第一の狭路支援制御の重みを元に戻すことで、第一の狭路支援制御を効果的に行うことができる。 This makes it difficult for the first narrow road assistance control and the second narrow road assistance control to intervene in control, and the driver can be prompted to perform an avoidance operation at a more appropriate timing. Moreover, the first narrow road support control can be effectively performed by returning the weight of the first narrow road support control to the original weight.
(4)前記閾値設定手段は、前記走路境界距離検出手段で検出した前記走路境界までの距離が短いほど、前記第一の閾値及び前記第二の閾値を大きくする。
これにより、走路境界との接触の可能性が高まるほど、第一の狭路支援制御と第二の狭路支援制御とが制御介入しやすくなり、より適切なタイミングで回避操作を運転者に促すことができる。
(4) The threshold value setting means increases the first threshold value and the second threshold value as the distance to the road boundary detected by the road boundary distance detection means is shorter.
As a result, as the possibility of contact with the road boundary increases, the first narrow road assistance control and the second narrow road assistance control are more likely to intervene and prompt the driver to perform an avoidance operation at a more appropriate timing. be able to.
(5)前記閾値設定手段は、前記走路境界に対する車体姿勢を検出する車体姿勢検出手段を有し、前記車体姿勢検出手段で検出した車体姿勢が右左折時旋回内側の前記走路境界に向いているほど、右左折時旋回内側における前記第一の閾値及び前記第二の閾値を大きくする。
これにより、走路境界との接触の可能性が高まるほど、第一の狭路支援制御と第二の狭路支援制御とが制御介入しやすくなり、より適切なタイミングで回避操作を運転者に促すことができる。
(5) The threshold value setting unit includes a vehicle body posture detection unit that detects a vehicle body posture with respect to the road boundary, and the vehicle body posture detected by the vehicle body posture detection unit is directed to the road boundary on the inner side of the turn when turning right or left. The first threshold value and the second threshold value inside the turn at the time of turning right and left are increased.
As a result, as the possibility of contact with the road boundary increases, the first narrow road assistance control and the second narrow road assistance control are more likely to intervene and prompt the driver to perform an avoidance operation at a more appropriate timing. be able to.
(6)前記閾値設定手段は、運転者の操舵角を検出する操舵角検出手段を有し、前記操舵角検出手段で検出した操舵角が右左折時旋回内側の前記走路境界に向いているほど、右左折時旋回内側における前記第一の閾値及び第二の閾値を大きくする。
これにより、走路境界との接触の可能性が高まるほど、第一の狭路支援制御と第二の狭路支援制御とが制御介入しやすくなり、より適切なタイミングで回避操作を運転者に促すことができる。
(6) The threshold value setting means includes a steering angle detection means for detecting a steering angle of the driver, and the steering angle detected by the steering angle detection means is closer to the running road boundary inside the turn when turning right or left. The first threshold value and the second threshold value inside the turn at the time of turning right and left are increased.
As a result, as the possibility of contact with the road boundary increases, the first narrow road assistance control and the second narrow road assistance control are more likely to intervene and prompt the driver to perform an avoidance operation at a more appropriate timing. be able to.
(7)前記閾値設定手段は、自車速を検出する車速検出手段を有し、前記車速検出手段で検出した自車速が高いほど、前記設定距離を長くする。
これにより、回避操作を行う余裕を考慮し、より適切なタイミングで回避操作を運転者に促すことができる。
(7) The threshold value setting unit includes a vehicle speed detection unit that detects the host vehicle speed, and increases the set distance as the host vehicle speed detected by the vehicle speed detection unit increases.
Accordingly, it is possible to prompt the driver to perform the avoidance operation at a more appropriate timing in consideration of a margin for performing the avoidance operation.
(8)前記閾値設定手段は、前記右左折路における旋回内側の前記走路境界のうち、自車がコーナ頂点を通過する際には、前記第一の閾値及び第二の閾値の間隔を予め定められた最小値に設定する。
これにより、第一の狭路支援制御よりも第二の狭路支援制御の重みを相対的に増加させることで、第一の狭路支援制御による煩わしさを軽減することができる。
(8) The threshold value setting means predetermines an interval between the first threshold value and the second threshold value when the own vehicle passes through a corner of the road boundary inside the turn on the right / left turn road. Set to the minimum value given.
Thereby, the troublesomeness by 1st narrow road assistance control can be reduced by making the weight of 2nd narrow road assistance control relatively increase rather than 1st narrow road assistance control.
(9)運転者のステアリング操作に対して支援トルクを付与可能とし、自車から左右の走路境界までの距離を検出すると共に、自車進路前方の右左折路で自車が右左折すると判断したときに、自車の現在位置と前記右左折路との距離を検出し、前記走路境界までの距離、及び前記右左折路との距離に応じて、第一の閾値、及び前記第一の閾値よりも小さな第二の閾値を設定し、前記走路境界までの距離が前記第一の閾値よりも短いときに、前記支援トルクに対して制御介入することで、前記走路境界への接近を抑制するための回避操作を運転者に促し、前記走路境界までの距離が前記第二の閾値よりも短いときに、前記支援トルクに対して制御介入することで、前記走路境界からの離間を促進するための回避操作を運転者に促す。 (9) Support torque can be applied to the driver's steering operation, and the distance from the vehicle to the left and right road boundary is detected, and it is determined that the vehicle turns right and left on the right-left turn road ahead of the vehicle. When the distance between the current position of the vehicle and the right / left turn road is detected, the first threshold value and the first threshold value are determined according to the distance to the road boundary and the distance to the right / left turn road. A smaller second threshold is set, and when the distance to the road boundary is shorter than the first threshold, the approach to the road boundary is suppressed by performing control intervention on the assist torque. In order to promote the separation from the road boundary by prompting the driver to perform an avoidance operation and intervening in control of the assist torque when the distance to the road boundary is shorter than the second threshold value. The driver is urged to avoid this.
このように、走路境界までの距離が第一の閾値よりも短いときには、走路境界への接近を抑制するための回避操作を運転者に促し、走路境界までの距離が第二の閾値よりも短いときには、走路境界からの離間を促進するための回避操作を運転者に促すので、狭路にて右左折をする際に、運転者に対して、適切なステアリング操作を直感的に促すことができる。 Thus, when the distance to the road boundary is shorter than the first threshold, the driver is prompted to perform an avoidance operation for suppressing the approach to the road boundary, and the distance to the road boundary is shorter than the second threshold. Occasionally, the driver is prompted to perform an avoidance operation to promote separation from the road boundary. Therefore, when making a right or left turn on a narrow road, the driver can be intuitively prompted to perform an appropriate steering operation. .
《第二実施形態》
《構成》
本実施形態は、分岐点進入区間32fにおいて、右左折時旋回外側に対しても、第一の閾値th1及び第二の閾値th2を設定するものである。
したがって、分岐点進入区間32fにて、旋回外側に対して第一の閾値th1及び第二の閾値th2を設定することを除いては、前述した第一実施形態と同様であるため、同一部分については詳細な説明を省略する。
<< Second Embodiment >>
"Constitution"
In the present embodiment, the first threshold value th1 and the second threshold value th2 are set also for the turning outside when turning right or left in the branch
Therefore, except for setting the first threshold th1 and the second threshold th2 with respect to the outside of the turn in the branch
分岐点進入区間32fにおいて、右左折時旋回外側に対する第一の閾値th1及び第二の閾値th2について説明する。
ここでは、分岐点32との距離yTが短いほど、旋回外側における第一の閾値th1及び第二の閾値th2を小さくし、且つ旋回外側における第一の閾値th1及び第二の閾値th2の間隔を小さくする。
In the branch
Here, the shorter the distance y T the
そして、前記ステップS609〜S611の各処理では、下記内容を追加する。
前記ステップS609では、右左折時旋回外側の側方物体までの距離yoが、第一の閾値th1よりも小さいか否かを判定する。この判定結果が『yo<th1』であれば、右左折時旋回外側の側方物体に対する回避操作が必要であると判断して前記ステップS610に移行する。一方、判定結果が『yo≧th1』であれば、右左折時旋回外側の側方物体に対する回避操作は不要であると判断して前記ステップS603に移行する。
And in each process of said step S609-S611, the following content is added.
In the step S609, the distance y o to the lateral object when turning right or left turning outside, determines smaller or not than the first threshold value th1. If this determination result is “y o <th1”, it is determined that an avoidance operation is required for the side object outside the turn at the time of turning right and left, and the process proceeds to step S610. On the other hand, if the determination result is “y o ≧ th1”, it is determined that the avoidance operation for the side object outside the right / left turn is not necessary, and the process proceeds to step S603.
前記ステップS610では、右左折時旋回外側における側方物体までの距離yoが、第二の閾値th2以上であるか否かを判定する。この判定結果が『yo≧th1』であれば、右左折時旋回外側の側方物体からの離間を促進する必要はないと判断して前記ステップS611に移行する。一方、判定結果が『yo<th2』であれば、右左折時旋回外側の側方物体からの離間を促進する必要があると判断して前記ステップS613に移行する。 In the step S610, the distance y o to the lateral object when turning right or left turning outside, it is determined whether the second threshold th2 or more. If this determination result is “y o ≧ th1”, it is determined that it is not necessary to promote the separation from the side object outside the turn when turning right or left, and the process proceeds to step S611. On the other hand, if the determination result is “y o <th2”, it is determined that it is necessary to promote the separation from the side object outside the turn when turning right or left, and the process proceeds to step S613.
前記ステップS611では、操舵角θが中立位置よりも右左折時旋回外側領域にあるか否かを判定する。ここで、操舵角θが中立位置よりも右左折時旋回外側領域にあるときには、右左折時旋回外側の側方物体への接近を抑制する必要があると判断して前記ステップS612に移行する。一方、操舵角θが中立位置にある、又は中立位置よりも右左折時旋回内側領域にあるときには、右左折時旋回外側の側方物体への接近を抑制する必要はないと判断して前記ステップS3に移行する。 In the step S611, it is determined whether or not the steering angle θ is in the turning outside region when turning right or left with respect to the neutral position. Here, when the steering angle θ is in the turning outside region when turning right or left with respect to the neutral position, it is determined that it is necessary to suppress the approach to the side object outside the turning when turning right or left, and the process proceeds to step S612. On the other hand, when the steering angle θ is in the neutral position or is in the inside area when turning right or left than the neutral position, it is determined that it is not necessary to suppress the approach to the side object outside the turning when turning right or left. The process proceeds to S3.
《作用》
図13は、分岐点進入区間における左折時旋回外側に対する第一の閾値th1及び第二の閾値th2を示す図である。
ここでは、左折時旋回内側に対する第一の閾値th1及び第二の閾値th2については前述した第一実施形態と同様である。一方、分岐点進入区間32fにおいて、左折時旋回外側に対する第一の閾値th1及び第二の閾値th2を、便宜上、走路境界31からの距離とし、走路境界31に沿ったラインとして図示している。通常、左折する際には、自車は内輪差を考慮して僅かに大回りする、つまり角部35との離間方向に僅かに膨らむように通行するので、こうしたステアリング操作を促すための設定を示す。
<Action>
FIG. 13 is a diagram showing a first threshold th1 and a second threshold th2 for the left turn turning outside in the branch point approach section.
Here, the first threshold th1 and the second threshold th2 with respect to the inside of the turn at the left turn are the same as those in the first embodiment described above. On the other hand, in the branch
先ず、分岐点進入区間32fよりも手前では、第一の閾値th1及び第二の閾値th2は略一定であり、第二の閾値th2は第一の閾値th1の半分程度の値である。すなわち、第一の閾値th1及び第二の閾値th2は、走路境界31と略平行なラインとなる。
First, before the branch
次に、分岐点進入区間32fからは、分岐点32に近づくほど、第一の閾値th1及び第二の閾値th2を小さくする。すなわち、第一の閾値th1及び第二の閾値th2は、走路境界31に接近するようなラインとなる。これにより、分岐点32に近づくほど、第一の狭路支援制御が介入する領域と、第二の狭路支援制御が介入する領域とが狭くなる。すなわち、右側の距離yoが第一の閾値th1や第二の閾値th2を下回りにくくなり、第一の狭路支援制御や第二の狭路支援制御が介入しにくくなる。
Next, from the branch
また、分岐点32に近づくほど、第一の閾値th1及び第二の閾値th2の間隔を小さくする。すなわち、第一の閾値th1と第二の閾値th2とが接近するようなラインとなる。これにより、分岐点32に近づくほど、第一の狭路支援制御が介入する領域が、第二の狭路支援制御が介入する領域よりも相対的に狭くなる。すなわち、右側の距離yoが第一の閾値th1を下回っても、すぐに第二の閾値th2を下回りやすくなり、第二の狭路支援制御が介入しやすくなる。
Further, the closer to the
したがって、左折時に、内輪差を考慮して僅かに大回りする、つまり角部35との離間方向に僅かに膨らむような通行を許容することができる。勿論、運転者が左折時にステアリングホイール16を大回りし過ぎていれば、先ず第一の狭路支援制御が作動し、走路境界31への接近が抑制される。それでもなお、走路境界31との接触の可能性があるときには、次に第二の狭路支援制御が作動し、走路境界31からの離間が促進される。
Therefore, when turning left, it is possible to allow passage that slightly turns in consideration of the inner ring difference, that is, slightly swells in the direction away from the
《効果》
(1)前記閾値設定手段は、前記右左折路よりも予め定められた設定距離だけ手前の進入区間では、前記右左折路距離検出手段で検出した前記右左折路との距離が近いほど、旋回外側における前記第一の閾値及び第二の閾値を小さくし、且つ旋回外側における前記第一の閾値及び第二の閾値の間隔を小さくする。
"effect"
(1) The threshold value setting means turns as the distance from the right / left turn road detected by the right / left turn road distance detection means becomes shorter in an approach section that is a predetermined distance ahead of the right / left turn road. The first threshold value and the second threshold value on the outside are reduced, and the interval between the first threshold value and the second threshold on the outside of the turn is reduced.
これにより、右左折時に、内輪差を考慮して僅かに大回りする、つまり右左折時旋回内側に存在する走路境界との離間方向に僅かに膨らむような通行を許容することができる。また、第一の狭路支援制御よりも第二の狭路支援制御の重みを相対的に増加させることで、第一の狭路支援制御による煩わしさを軽減することができる。 Accordingly, it is possible to allow a passage that slightly turns in consideration of an inner ring difference when turning right or left, that is, slightly swells in a direction away from a road boundary existing inside the turning when turning right or left. Moreover, the troublesomeness by 1st narrow road assistance control can be reduced by making the weight of 2nd narrow road assistance control relatively increase rather than 1st narrow road assistance control.
《第三実施形態》
《構成》
本実施形態は、分岐点進出区間32bにおいて、右左折時旋回外側に対しても、第一の閾値th1及び第二の閾値th2を設定するものである。
したがって、分岐点進出区間32bにて、旋回外側に対して第一の閾値th1及び第二の閾値th2を設定することを除いては、前述した第一実施形態と同様であるため、同一部分については詳細な説明を省略する。
<< 3rd embodiment >>
"Constitution"
In the present embodiment, the first threshold value th1 and the second threshold value th2 are set for the turning outside when turning right or left in the branch
Therefore, except for setting the first threshold th1 and the second threshold th2 with respect to the outside of the turn in the branch
分岐点進出区間32b及び分岐点32において、右左折時旋回外側に対する第一の閾値th1及び第二の閾値th2について説明する。
The first threshold value th1 and the second threshold value th2 for the turning outside when turning right or left in the branch
ここでは、分岐点32との距離yTが短いほど、旋回外側における第一の閾値th1及び第二の閾値th2を小さくし、且つ旋回外側における第一の閾値th1及び第二の閾値th2の間隔を大きくする。
Here, the shorter the distance y T the
そして、前記ステップS609〜S611の各処理では、下記内容を追加する。
前記ステップS609では、右左折時旋回外側の側方物体までの距離yoが、第一の閾値th1よりも小さいか否かを判定する。この判定結果が『yo<th1』であれば、右左折時旋回外側の側方物体に対する回避操作が必要であると判断して前記ステップS610に移行する。一方、判定結果が『yo≧th1』であれば、右左折時旋回外側の側方物体に対する回避操作は不要であると判断して前記ステップS603に移行する。
And in each process of said step S609-S611, the following content is added.
In the step S609, the distance y o to the lateral object when turning right or left turning outside, determines smaller or not than the first threshold value th1. If this determination result is “y o <th1”, it is determined that an avoidance operation is required for the side object outside the turn at the time of turning right and left, and the process proceeds to step S610. On the other hand, if the determination result is “y o ≧ th1”, it is determined that the avoidance operation for the side object outside the right / left turn is not necessary, and the process proceeds to step S603.
前記ステップS610では、右左折時旋回外側における側方物体までの距離yoが、第二の閾値th2以上であるか否かを判定する。この判定結果が『yo≧th1』であれば、右左折時旋回外側の側方物体からの離間を促進する必要はないと判断して前記ステップS611に移行する。一方、判定結果が『yo<th2』であれば、右左折時旋回外側の側方物体からの離間を促進する必要があると判断して前記ステップS613に移行する。 In the step S610, the distance y o to the lateral object when turning right or left turning outside, it is determined whether the second threshold th2 or more. If this determination result is “y o ≧ th1”, it is determined that it is not necessary to promote the separation from the side object outside the turn when turning right or left, and the process proceeds to step S611. On the other hand, if the determination result is “y o <th2”, it is determined that it is necessary to promote the separation from the side object outside the turn when turning right or left, and the process proceeds to step S613.
前記ステップS611では、操舵角θが中立位置よりも右左折時旋回外側領域にあるか否かを判定する。ここで、操舵角θが中立位置よりも右左折時旋回外側領域にあるときには、右左折時旋回外側の側方物体への接近を抑制する必要があると判断して前記ステップS612に移行する。一方、操舵角θが中立位置にある、又は中立位置よりも右左折時旋回内側領域にあるときには、右左折時旋回外側の側方物体への接近を抑制する必要はないと判断して前記ステップS3に移行する。 In the step S611, it is determined whether or not the steering angle θ is in the turning outside region when turning right or left with respect to the neutral position. Here, when the steering angle θ is in the turning outside region when turning right or left with respect to the neutral position, it is determined that it is necessary to suppress the approach to the side object outside the turning when turning right or left, and the process proceeds to step S612. On the other hand, when the steering angle θ is in the neutral position or is in the inside area when turning right or left than the neutral position, it is determined that it is not necessary to suppress the approach to the side object outside the turning when turning right or left. The process proceeds to S3.
《作用》
図14は、分岐点進出区間における左折時旋回外側に対する第一の閾値th1及び第二の閾値th2を示す図である。
<Action>
FIG. 14 is a diagram showing a first threshold th1 and a second threshold th2 for the left turn turning outside in the branch point advance section.
ここでは、左折時旋回内側に対する第一の閾値th1及び第二の閾値th2については前述した第一実施形態と同様である。一方、分岐点進出区間32bにおいて、左折時旋回外側に対する第一の閾値th1及び第二の閾値th2を、便宜上、走路境界34からの距離とし、走路境界34に沿ったラインとして図示している。通常、左折する際には、自車は内輪差を考慮して僅かに大回りする、つまり角部35との離間方向に僅かに膨らむように通行するので、こうしたステアリング操作を促すための設定を示す。
Here, the first threshold th1 and the second threshold th2 with respect to the inside of the turn at the left turn are the same as those in the first embodiment described above. On the other hand, in the branch
先ず、分岐点進出区間32bからは、分岐点32から離れるほど、第一の閾値th1及び第二の閾値th2を小さくする。すなわち、第一の閾値th1及び第二の閾値th2は、走路境界34へと接近するようなラインとなる。これにより、分岐点32から離れるほど、第一の狭路支援制御が介入する領域と、第二の狭路支援制御が介入する領域とが狭くなる。すなわち、右側の距離yoが第一の閾値th1や第二の閾値th2を下回りにくくなり、第一の狭路支援制御や第二の狭路支援制御が介入しにくくなる。
First, the first threshold th1 and the second threshold th2 are decreased from the branch
また、分岐点32から離れるほど、第一の閾値th1及び第二の閾値th2の間隔を大きくする。すなわち、第一の閾値th1と第二の閾値th2とが離間するようなラインとなる。これにより、分岐点32から離れるほど、第一の狭路支援制御が介入する領域の幅が、第二の狭路支援制御が介入する領域の幅に近づいてゆく。すなわち、右側の距離yoが第一の閾値th1を下回っても、すぐに第二の閾値th2を下回ることが起きにくくなり、第一の狭路支援制御が維持されやすくなる。
Further, as the distance from the
したがって、左折時に、内輪差を考慮して僅かに大回りする、つまり角部35との離間方向に僅かに膨らむような通行を許容することができる。勿論、運転者が左折時にステアリングホイール16を大回りし過ぎていれば、先ず第一の狭路支援制御が作動し、走路境界31への接近が抑制される。それでもなお、走路境界31との接触の可能性があるときには、次に第二の狭路支援制御が作動し、走路境界31からの離間が促進される。
Therefore, when turning left, it is possible to allow passage that slightly turns in consideration of the inner ring difference, that is, slightly swells in the direction away from the
《効果》
(1)前記閾値設定手段は、前記右左折路よりも予め定められた設定距離だけ先方の進出区間では、前記右左折路距離検出手段で検出した前記右左折路との距離が離れるほど、旋回外側における前記第一の閾値及び前記第二の閾値を小さくし、且つ旋回外側における前記第一の閾値及び前記第二の閾値の間隔を大きくすることを特徴とする請求項1〜4の何れか一項に記載の狭路走行支援装置。
"effect"
(1) The threshold value setting means turns as the distance from the right / left turn road detected by the right / left turn road distance detection means increases in an advancing section ahead by a predetermined distance from the right / left turn road. The first threshold value and the second threshold value on the outside are reduced, and the interval between the first threshold value and the second threshold value on the outside of the turn is increased. The narrow road driving support device according to one item.
これにより、右左折時に、内輪差を考慮して僅かに大回りする、つまり右左折時旋回内側に存在する走路境界との離間方向に僅かに膨らむような通行を許容することができる。また、第一の狭路支援制御の重みを元に戻すことで、第一の狭路支援制御を効果的に行うことができる。 Accordingly, it is possible to allow a passage that slightly turns in consideration of an inner ring difference when turning right or left, that is, slightly swells in a direction away from a road boundary existing inside the turning when turning right or left. Moreover, the first narrow road support control can be effectively performed by returning the weight of the first narrow road support control to the original weight.
10 自車
11L ソナーセンサ
11R ソナーセンサ
12 コントローラ
13 電動モータ
14 トルクセンサ
15 ステアリングシャフト
16 ステアリングホイール
17 舵角センサ
18 車速センサ
19 制御介入判断部
20 助勢トルク指令値演算部
21 狭路支援制御介入部
22 フィードバック偏差演算部
23 回避トルク指令値演算部
24 レートリミッタ
25 助勢トルク指令値補正部
26 加算器
30 走路境界
31 走路境界
32 分岐点
32f 分岐点進入区間
32b 分岐点進出区間
33 走路境界
34 走路境界
35 角部
36 角部
DESCRIPTION OF
Claims (11)
自車から左右の走路境界までの距離を検出する走路境界距離検出手段と、
自車進路前方の右左折路で自車が右左折するか否かを判断する右左折判断手段と、
前記右左折判断手段で自車が右左折すると判断したときに、自車の現在位置と前記右左折路との距離を検出する右左折路距離検出手段と、
前記走路境界距離検出手段で検出した前記走路境界までの距離、及び前記右左折路距離検出手段で検出した前記右左折路との距離に応じて、第一の閾値、及び前記第一の閾値よりも小さな第二の閾値を設定する閾値設定手段と、
前記走路境界距離検出手段で検出した前記走路境界までの距離が、前記閾値設定手段で設定した第一の閾値よりも短いときに、前記付与手段の前記支援トルクに対して制御介入することで、前記走路境界への接近を抑制するための回避操作を運転者に促し、前記走路境界距離検出手段で検出した前記走路境界までの距離が、前記閾値設定手段で設定した第二の閾値よりも短いときに、前記付与手段の前記支援トルクに対して制御介入することで、前記走路境界からの離間を促進するための回避操作を運転者に促す制御介入手段と、を備えることを特徴とする狭路走行支援装置。 An imparting means capable of imparting assist torque to the driver's steering operation;
A road boundary distance detecting means for detecting a distance from the own vehicle to the left and right road boundary;
A right / left turn judging means for judging whether or not the vehicle turns right / left on the right / left turn road ahead of the own vehicle course;
A right / left turn road distance detecting means for detecting a distance between the current position of the own vehicle and the right / left turn road when the right / left turn determination means determines that the own vehicle turns right / left;
Depending on the distance to the road boundary detected by the road boundary distance detection means and the distance from the right / left turn road detected by the right / left turn distance detection means, a first threshold value and a first threshold value A threshold setting means for setting a small second threshold,
When the distance to the road boundary detected by the road boundary distance detection means is shorter than the first threshold set by the threshold setting means, the control intervention for the support torque of the applying means, The driver is urged to perform an avoidance operation for suppressing the approach to the road boundary, and the distance to the road boundary detected by the road boundary distance detection unit is shorter than the second threshold set by the threshold setting unit. And a control intervention means for urging the driver to perform an avoidance operation for promoting separation from the lane boundary by performing control intervention on the support torque of the applying means. Road driving support device.
自車から左右の走路境界までの距離を検出すると共に、自車進路前方の右左折路で自車が右左折すると判断したときに、自車の現在位置と前記右左折路との距離を検出し、前記走路境界までの距離、及び前記右左折路との距離に応じて、第一の閾値、及び前記第一の閾値よりも小さな第二の閾値を設定し、
前記走路境界までの距離が前記第一の閾値よりも短いときに、前記支援トルクに対して制御介入することで、前記走路境界への接近を抑制するための回避操作を運転者に促し、前記走路境界までの距離が前記第二の閾値よりも短いときに、前記支援トルクに対して制御介入することで、前記走路境界からの離間を促進するための回避操作を運転者に促すことを特徴とする狭路走行支援方法。 Support torque can be applied to the driver's steering operation.
Detects the distance from the own vehicle to the left and right track boundaries, and also detects the distance between the current position of the own vehicle and the right / left turn when it is determined that the vehicle will turn left or right on the right or left turn ahead of the vehicle And according to the distance to the road boundary and the distance to the right and left turn road, a first threshold value and a second threshold value smaller than the first threshold value are set.
When the distance to the road boundary is shorter than the first threshold, by intervening control with respect to the support torque, to prompt the driver to avoid the operation to suppress the approach to the road boundary, When the distance to the road boundary is shorter than the second threshold, the driver is urged to perform an avoidance operation to promote separation from the road boundary by performing control intervention on the assist torque. Narrow road driving support method.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010121319A JP5540888B2 (en) | 2010-05-27 | 2010-05-27 | Narrow road driving support device and narrow road driving support method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010121319A JP5540888B2 (en) | 2010-05-27 | 2010-05-27 | Narrow road driving support device and narrow road driving support method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2011245983A true JP2011245983A (en) | 2011-12-08 |
JP5540888B2 JP5540888B2 (en) | 2014-07-02 |
Family
ID=45411794
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010121319A Expired - Fee Related JP5540888B2 (en) | 2010-05-27 | 2010-05-27 | Narrow road driving support device and narrow road driving support method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5540888B2 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014101023A (en) * | 2012-11-20 | 2014-06-05 | Honda Motor Co Ltd | Turning support device |
JP2020158007A (en) * | 2019-03-27 | 2020-10-01 | 日産自動車株式会社 | Behavior prediction method and behavior prediction device |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11301509A (en) * | 1998-04-22 | 1999-11-02 | Koyo Seiko Co Ltd | Electric power steering device |
JP2007210458A (en) * | 2006-02-09 | 2007-08-23 | Nissan Motor Co Ltd | Display device for vehicle and image display control method for vehicle |
JP2008217360A (en) * | 2007-03-02 | 2008-09-18 | Toyota Motor Corp | Left/right turn supporting device |
JP2010070069A (en) * | 2008-09-19 | 2010-04-02 | Hitachi Automotive Systems Ltd | Vehicle control apparatus |
-
2010
- 2010-05-27 JP JP2010121319A patent/JP5540888B2/en not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11301509A (en) * | 1998-04-22 | 1999-11-02 | Koyo Seiko Co Ltd | Electric power steering device |
JP2007210458A (en) * | 2006-02-09 | 2007-08-23 | Nissan Motor Co Ltd | Display device for vehicle and image display control method for vehicle |
JP2008217360A (en) * | 2007-03-02 | 2008-09-18 | Toyota Motor Corp | Left/right turn supporting device |
JP2010070069A (en) * | 2008-09-19 | 2010-04-02 | Hitachi Automotive Systems Ltd | Vehicle control apparatus |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014101023A (en) * | 2012-11-20 | 2014-06-05 | Honda Motor Co Ltd | Turning support device |
JP2020158007A (en) * | 2019-03-27 | 2020-10-01 | 日産自動車株式会社 | Behavior prediction method and behavior prediction device |
JP7336861B2 (en) | 2019-03-27 | 2023-09-01 | 日産自動車株式会社 | Behavior prediction method and behavior prediction device |
Also Published As
Publication number | Publication date |
---|---|
JP5540888B2 (en) | 2014-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9321462B2 (en) | Lane deviation prevention control apparatus of vehicle | |
US9573593B2 (en) | Lane deviation prevention control apparatus of vehicle | |
JP5080602B2 (en) | Vehicle control device | |
KR101398223B1 (en) | Control apparatus of vehicle for changing lane and Control method of the same | |
JP6432679B2 (en) | Stop position setting apparatus and method | |
JP6638041B1 (en) | Lane keeping control device | |
JP4666631B2 (en) | Vehicle steering control device and vehicle | |
US9610976B2 (en) | Lane departure prevention control system for vehicle | |
JP5853552B2 (en) | Vehicle travel control device | |
JP6196518B2 (en) | Driving assistance device | |
JP2014024472A (en) | Vehicular power steering control unit | |
JP2015202758A (en) | Drive support apparatus | |
JP5510037B2 (en) | Narrow road driving support device and narrow road driving support method | |
JP2014196039A (en) | Drive assist | |
JP2013086782A (en) | Driving support device for vehicle | |
JP2018083578A (en) | Intra-lane travel support apparatus | |
JP5540888B2 (en) | Narrow road driving support device and narrow road driving support method | |
JP6338417B2 (en) | Vehicle lane departure prevention control device | |
KR20160134105A (en) | Apparatus and method for controlling lane keeping | |
JP2017047705A (en) | Device and method for controlling vehicle behavior | |
JP2020015444A (en) | Vehicle control apparatus | |
JP2008055985A (en) | Contact avoidance assistant device for vehicle | |
KR20150107361A (en) | Apparatus for line keeping assistant in a vehicle and method thereof | |
JP6541216B2 (en) | Vehicle lane departure prevention control device | |
JP5655919B2 (en) | Lane departure prevention device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20130327 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20131119 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20131121 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20131213 |
|
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: 20140408 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20140421 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 5540888 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
LAPS | Cancellation because of no payment of annual fees |