[go: up one dir, main page]

JP4434095B2 - Steering device - Google Patents

Steering device Download PDF

Info

Publication number
JP4434095B2
JP4434095B2 JP2005198948A JP2005198948A JP4434095B2 JP 4434095 B2 JP4434095 B2 JP 4434095B2 JP 2005198948 A JP2005198948 A JP 2005198948A JP 2005198948 A JP2005198948 A JP 2005198948A JP 4434095 B2 JP4434095 B2 JP 4434095B2
Authority
JP
Japan
Prior art keywords
offset
integration
value
curve
predetermined position
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
Application number
JP2005198948A
Other languages
Japanese (ja)
Other versions
JP2007015545A (en
Inventor
克彦 岩▲崎▼
チュムサムット ラッタポン
清治 河上
寛暁 片岡
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2005198948A priority Critical patent/JP4434095B2/en
Publication of JP2007015545A publication Critical patent/JP2007015545A/en
Application granted granted Critical
Publication of JP4434095B2 publication Critical patent/JP4434095B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Steering Control In Accordance With Driving Conditions (AREA)
  • Power Steering Mechanism (AREA)

Description

本発明は、走行路の撮像画像により車両が走行路の所定位置に沿って走行するように操舵機構に操舵トルクを付与する操舵装置に関する。   The present invention relates to a steering device that applies a steering torque to a steering mechanism so that a vehicle travels along a predetermined position on a travel path based on a captured image of the travel path.

操舵装置には、車両前方の走行路の撮像画像から車線を認識し、車両が車線中央に沿って走行するように操舵トルクを操舵機構に付加するレーンキープ装置がある。レーンキープ装置では、認識した車線と車両との関係から走行路のカーブ半径(曲率)、車線に対する車両のヨー角、車線中心からの車両のオフセットなどを求め、これらのパラメータに基づいて付加操舵トルクを設定する。また、操舵装置には、車両挙動に影響を及ぼす外乱(横風など)の発生時に、外乱を打ち消すための修正操舵トルクを操舵機構に付加するものもある(特許文献1参照)。この操舵装置では、横加速度やヨーレート及び操舵角や操舵トルクに基づいて外乱影響値を設定したり、あるいは、外乱による定常偏差を除去するために、横加速度の2階時間積分値(車両横方向位置変化量)やヨーレートの1階時間積分値(ヨー角)から求められる外乱による車両挙動の積算値の正の相関値として外乱影響値を設定する。このように積分値を利用して制御を行うものとしては、レーンキープ装置でも、車線中心からの車両のオフセットの時間積分値も考慮して付加操舵トルクを設定するものがある。
特開2001−1923号公報
As a steering device, there is a lane keeping device that recognizes a lane from a captured image of a traveling road ahead of the vehicle and applies a steering torque to the steering mechanism so that the vehicle travels along the center of the lane. In the lane keeping device, the curve radius (curvature) of the road, the yaw angle of the vehicle with respect to the lane, the vehicle offset from the lane center, etc. are obtained from the relationship between the recognized lane and the vehicle, and the additional steering torque is based on these parameters. Set. Some steering devices add a correction steering torque for canceling the disturbance to the steering mechanism when a disturbance (such as a crosswind) that affects the vehicle behavior occurs (see Patent Document 1). In this steering device, in order to set the disturbance influence value based on the lateral acceleration, the yaw rate, the steering angle, and the steering torque, or to remove the steady-state deviation due to the disturbance, the second-order integration value of the lateral acceleration (the vehicle lateral direction) The disturbance influence value is set as a positive correlation value of the integrated value of the vehicle behavior due to the disturbance obtained from the position change amount) and the first-order time integral value (yaw angle) of the yaw rate. In this way, the control using the integral value includes a lane keeping device that sets the additional steering torque in consideration of the time integral value of the vehicle offset from the center of the lane.
JP 2001-1923 A

道路には、排水やカーブの方向などを考慮し、道路の左右どちらかの方向に傾けた横断勾配が設けられている。そのため、車両には、横断勾配の影響により、道路の右方向または左方向に向かって重力成分が作用する。従来のオフセットの積分値も用いるレーンキープ装置では、オフセットの積分値に基づいて、重力成分が作用する方向とは逆方向に付加する付加操舵トルクを設定している。   In consideration of drainage and the direction of the curve, the road is provided with a cross slope inclined in either direction of the road. Therefore, a gravity component acts on the vehicle toward the right or left of the road due to the influence of the cross gradient. In a conventional lane keeping device that also uses an integrated value of an offset, an additional steering torque that is applied in a direction opposite to the direction in which the gravity component acts is set based on the integrated value of the offset.

しかし、カーブに進入し、カーブの方向に応じて横断勾配の方向が急に変わると、車両に作用する重力成分の方向も変わる。その結果、カーブに進入する前に付加していた操舵トルクの方向とカーブ進入後の重力成分が作用する方向とが同じ方向となる。そのため、車両に対してその重力成分が作用する方向に更に操舵トルクが作用し、車両が車線中心から離れてしまう。つまり、横断勾配に応じた適切な操舵トルクが付与されていない状態になる。   However, if the vehicle enters the curve and the direction of the cross gradient suddenly changes according to the direction of the curve, the direction of the gravity component acting on the vehicle also changes. As a result, the direction of the steering torque applied before entering the curve is the same as the direction in which the gravity component after entering the curve acts. Therefore, the steering torque further acts in the direction in which the gravity component acts on the vehicle, and the vehicle is separated from the lane center. In other words, an appropriate steering torque according to the crossing gradient is not applied.

そこで、本発明は、横断勾配に応じた適切な操舵トルクを付与することできる操舵装置を提供することを課題とする。   Then, this invention makes it a subject to provide the steering device which can provide the appropriate steering torque according to a cross gradient.

本発明に係る操舵装置は、撮像手段により走行路を撮像し、車両が走行路の所定位置に沿って走行するように操舵機構に操舵トルクを付与する操舵装置において、走行路の所定位置に対する車両位置の偏差を積分し、走行路の所定位置に対する右側分の積分値を求める第1積分手段と、走行路の所定位置に対する車両位置の偏差を積分し、走行路の所定位置に対する左側分の積分値を求める第2積分手段と、走行路の所定位置に対する車両位置の偏差と走行路の所定位置からの所定距離に基づいて第1積分手段と第2積分手段とを切り替える切替手段と、切替手段で切り替えた積分手段の積分値に基づいて操舵機構に付与する操舵トルクを設定する操舵トルク設定手段とを備え、走行路の曲率が大きいときは走行路の曲率が小さいときより第1積分手段と第2積分手段との切り替えが行われ難くすることを特徴とする。   A steering apparatus according to the present invention is a steering apparatus that images a travel path by an imaging unit and applies a steering torque to a steering mechanism so that the vehicle travels along a predetermined position on the travel path. A first integrating means for integrating the deviation of the position to obtain an integral value for the right side with respect to the predetermined position on the road; and integrating the deviation of the vehicle position with respect to the predetermined position on the road to integrate the left side with respect to the predetermined position on the road Second integration means for obtaining a value, switching means for switching between the first integrating means and the second integrating means based on a deviation of the vehicle position with respect to a predetermined position on the traveling road and a predetermined distance from the predetermined position on the traveling road, and switching means Steering torque setting means for setting a steering torque to be applied to the steering mechanism based on the integrated value of the integration means switched in step (5), when the curvature of the traveling road is large than when the curvature of the traveling road is small. The switching of the integrating means and second integration means, characterized in that hardly performed.

この操舵装置では、走行路の撮像画像から走行路の所定位置に対する車両位置の偏差を求め、第1積分手段により走行路の所定位置に対する右側分の積分値を求めるとともに、第2積分手段により走行路の所定位置に対する左側分の積分値を求める。そして、操舵装置では、切替手段により走行路の所定位置からの所定距離を基準として所定位置からの偏差に応じて第1積分手段と第2積分手段とを切り替える。さらに、操舵装置では、偏差の積分値が増加しないように(すなわち、所定位置に近づくように)、操舵トルク設定手段により切り替えた積分手段で求めた積分値に基づいて操舵機構に付与する操舵トルクを設定し、この設定した操舵トルクを操舵機構に付与する。横断勾配の方向が変わり、車両に作用する重力成分の方向が変わった場合、その重力成分の影響により、その変わった重力成分の方向側への偏差が増加する。そのため、操舵装置では、その他方側の積分手段の積分値に基づいて操舵トルクを付与していた場合でも、その偏差が増加する側の積分手段に切り替えることができ、その偏差の積分値が増加しないように、切り替えた積分手段の積分値に基づいて操舵トルクを付与することができる。その結果、車両に対して重力成分が作用する方向とは逆方向に操舵トルクが作用し、車両が走行路の所定位置に近づいていく。さらに、操舵装置では、走行路の曲率が大きい(カーブ半径が小さい)ときには走行路の曲率が小さい(カーブ半径が大きい)ときより第1積分手段と第2積分手段との切り替えが行われ難くする。これによって、直線や直線に近い走行路を走行中のときよりカーブ走行中に積分手段の切り替えを抑制することができ、カーブ走行途中での大きな車両変動やドライバに対するステアリングホイールを介した反力変動を抑制することができる。このように、この操舵装置では、横断勾配に応じて適切な操舵トルクを付与することでき、車両を所定位置に沿って走行させる精度を向上させることができる。   In this steering apparatus, the deviation of the vehicle position with respect to the predetermined position on the traveling road is obtained from the captured image of the traveling road, the integral value for the right side with respect to the predetermined position on the traveling road is obtained by the first integrating means, and the traveling by the second integrating means. The integral value for the left side of the predetermined position on the road is obtained. In the steering apparatus, the switching means switches between the first integrating means and the second integrating means in accordance with the deviation from the predetermined position with reference to the predetermined distance from the predetermined position on the travel path. Further, in the steering device, the steering torque applied to the steering mechanism based on the integrated value obtained by the integrating means switched by the steering torque setting means so that the integrated value of the deviation does not increase (that is, approaches the predetermined position). And the set steering torque is applied to the steering mechanism. When the direction of the transverse gradient changes and the direction of the gravity component acting on the vehicle changes, the deviation of the changed gravity component toward the direction increases due to the influence of the gravity component. Therefore, in the steering device, even when the steering torque is applied based on the integration value of the other-side integration means, it can be switched to the integration means on the side where the deviation increases, and the integration value of the deviation increases. Therefore, the steering torque can be applied based on the integrated value of the switched integration means. As a result, the steering torque acts in a direction opposite to the direction in which the gravity component acts on the vehicle, and the vehicle approaches a predetermined position on the travel path. Further, in the steering device, when the curvature of the traveling road is large (the curve radius is small), switching between the first integrating means and the second integrating means is less likely to be performed than when the curvature of the traveling road is small (the curve radius is large). . As a result, it is possible to suppress switching of the integration means during curve driving than when driving on a straight line or a road that is close to a straight line, and large vehicle fluctuations during curve driving and reaction force fluctuations via the steering wheel for the driver Can be suppressed. Thus, in this steering apparatus, it is possible to apply an appropriate steering torque according to the crossing gradient, and it is possible to improve the accuracy of traveling the vehicle along the predetermined position.

なお、走行路としては、例えば、走行中の車線、車線のない場合には走行中の道路自体である。走行路の所定位置としては、例えば、走行路(車線)の中心である。走行路の所定位置からの所定距離は、第1積分手段と第2積分手段とを切り替える基準となる距離である。   The traveling road is, for example, a traveling lane or a traveling road when there is no lane. The predetermined position of the travel path is, for example, the center of the travel path (lane). The predetermined distance from the predetermined position on the travel path is a reference distance for switching between the first integrating means and the second integrating means.

本発明の上記操舵装置では、走行路の所定位置からの所定距離を走行路の曲率に基づいて決定する構成としてもよい。   The steering apparatus according to the present invention may be configured such that a predetermined distance from a predetermined position on the travel path is determined based on the curvature of the travel path.

この操舵装置では、切り替えの基準となる走行路の所定位置からの所定距離を走行路の曲率(カーブ半径の逆数)に基づいて決定する。これによって、操舵装置では、走行路の曲率が大きいときには走行路の曲率が小さいときより第1積分手段と第2積分手段との切り替えが行われ難くするように、走行路がカーブか直線あるいは曲率(カーブ半径の逆数)に応じて所定距離の値を変更し、積分手段の切り替える条件を変えることができる。   In this steering apparatus, a predetermined distance from a predetermined position on the travel path serving as a reference for switching is determined based on the curvature of the travel path (the reciprocal of the curve radius). Thus, in the steering device, when the curvature of the traveling road is large, the traveling road is curved, straight, or curved so that the switching between the first integrating means and the second integrating means is less likely to be performed than when the curvature of the traveling road is small. The condition for switching the integration means can be changed by changing the value of the predetermined distance in accordance with (the reciprocal of the curve radius).

本発明の上記操舵装置では、走行路の所定位置からの所定距離を走行路の曲率が大きくなるほど大きくする構成としてもよい。   In the above steering device of the present invention, the predetermined distance from the predetermined position on the travel path may be configured to increase as the curvature of the travel path increases.

この操舵装置では、走行路の曲率が大きくなるほど(つまり、カーブ半径が小さくなるほど)、走行路の所定位置からの所定距離を大きくする。このように、カーブ半径が小さくなるほど、積分手段の切り替え基準を大きくすることにより、カーブで積分手段が切り替わり難くなる。そのため、カーブ走行中の車両挙動を安定化でき、ドライバに対する操舵反力変動を抑制できる。   In this steering apparatus, the predetermined distance from the predetermined position on the travel path is increased as the curvature of the travel path increases (that is, the curve radius decreases). As described above, the smaller the curve radius is, the more difficult the switching of the integration means is made by the curve by increasing the switching reference of the integration means. Therefore, it is possible to stabilize the vehicle behavior during the curve traveling and to suppress the steering reaction force fluctuation with respect to the driver.

本発明に係る操舵装置は、画像手段により走行路を撮像し、車両が走行路の所定位置に沿って走行するように操舵機構に操舵トルクを付与する操舵装置において、走行路の所定位置に対する車両位置の偏差を積分し、走行路の所定位置に対する右側分の積分値を求める第1積分手段と、走行路の所定位置に対する車両位置の偏差を積分し、走行路の所定位置に対する左側分の積分値を求める第2積分手段と、走行路の所定位置に対する車両位置の偏差と走行路の所定位置からの所定距離に基づいて第1積分手段と第2積分手段とを切り替える切替手段と、切替手段で切り替えた積分手段の積分値に基づいて操舵機構に付与する操舵トルクを設定する操舵トルク設定手段とを備え、切替手段は、第1積分手段または第2積分手段のいずれか一方の積分手段に切り替えられている状態で、当該切り替えられている一方の積分手段の他方側における走行路の所定位置に対する車両位置の偏差が走行路の所定位置からの所定距離の絶対値以下の場合、当該切り替えられている一方の積分手段の積分値が0あるいは0近傍のときに他方の積分手段に切り替えることを特徴とする。   The steering apparatus according to the present invention is a steering apparatus that images a travel path by an image means and applies a steering torque to a steering mechanism so that the vehicle travels along a predetermined position on the travel path. A first integrating means for integrating the deviation of the position to obtain an integral value for the right side with respect to the predetermined position on the road; and integrating the deviation of the vehicle position with respect to the predetermined position on the road to integrate the left side with respect to the predetermined position on the road Second integration means for obtaining a value, switching means for switching between the first integrating means and the second integrating means based on a deviation of the vehicle position with respect to a predetermined position on the traveling road and a predetermined distance from the predetermined position on the traveling road, and switching means And a steering torque setting means for setting a steering torque to be applied to the steering mechanism based on the integrated value of the integrating means switched in step 1, wherein the switching means is either the first integrating means or the second integrating means. When the deviation of the vehicle position with respect to the predetermined position of the traveling road on the other side of the switched one of the integrating means is not more than the absolute value of the predetermined distance from the predetermined position of the traveling road in a state where the integral means is switched, When the integration value of one of the switched integration means is 0 or close to 0, the other integration means is switched.

この操舵装置では、走行路の撮像画像から走行路の所定位置に対する車両位置の偏差を求め、第1積分手段により走行路の所定位置に対する右側分の積分値を求めるとともに、第2積分手段により走行路の所定位置に対する左側分の積分値を求める。そして、操舵装置では、切替手段により走行路の所定位置からの所定距離を基準として所定位置からの偏差に応じて第1積分手段と第2積分手段とを切り替える。さらに、操舵装置では、操舵トルク設定手段により切り替えた積分手段で求めた積分値に基づいて操舵機構に付与する操舵トルクを設定し、この設定した操舵トルクを操舵機構に付与する。特に、操舵装置では、2つの積分手段のいずれか一方に切り替えられている状態で、切替手段により、車両の他方側の偏差が走行路の所定位置からの所定距離の絶対値以下の場合でも、その一方の積分手段の積分値が0あるいは0近傍と判定したときには一方の積分手段から他方の積分手段に切り替える。このように、他方側の偏差が切り替える基準以下で一方の積分手段から他方の積分手段に切り替えができない場合でも、選択中の積分値が非常に小さくなって選択中の積分値の影響が無くなっているときには選択中の積分手段から他方の積分手段に切り替えることができ、他方側の積分値を基づいて操舵トルクを付与することができる。例えば、直線からカーブになる場合やS字カーブでカーブの方向が変わる場合には横断勾配が変わるので、カーブ進入後に重力成分が作用しない側の積分手段が選択されているときには、重力成分が作用する側の適切な積分手段に切り替えることができる。つまり、横断勾配に応じた適切な積分手段が選択されていない場合には、横断勾配に応じた積分手段に迅速に切り替えることができる。このように、操舵装置では、横断勾配に応じて適切な操舵トルクを付与することでき、車両を所定位置に沿って走行させる精度を向上させることができる。   In this steering apparatus, the deviation of the vehicle position with respect to the predetermined position on the traveling road is obtained from the captured image of the traveling road, the integral value for the right side with respect to the predetermined position on the traveling road is obtained by the first integrating means, and the traveling by the second integrating means. The integral value for the left side of the predetermined position on the road is obtained. In the steering apparatus, the switching means switches between the first integrating means and the second integrating means in accordance with the deviation from the predetermined position with reference to the predetermined distance from the predetermined position on the travel path. Further, the steering device sets the steering torque to be applied to the steering mechanism based on the integral value obtained by the integrating means switched by the steering torque setting means, and applies the set steering torque to the steering mechanism. In particular, in the steering apparatus, even when the deviation on the other side of the vehicle is equal to or smaller than the absolute value of the predetermined distance from the predetermined position on the travel path by the switching means while being switched to one of the two integrating means, When it is determined that the integration value of one of the integration means is 0 or close to 0, the one integration means is switched to the other integration means. In this way, even if the deviation on the other side is less than the reference for switching and switching from one integrating means to the other integrating means is not possible, the integral value being selected becomes very small and the influence of the integral value being selected is eliminated. When it is, the integration means being selected can be switched to the other integration means, and the steering torque can be applied based on the integration value on the other side. For example, when the curve changes from a straight line or when the direction of the curve changes with an S-curve, the crossing gradient changes. Therefore, when the integration means on the side where the gravity component does not act is selected after entering the curve, the gravity component acts. It is possible to switch to an appropriate integration means on the side to be performed. In other words, when an appropriate integration means corresponding to the cross gradient is not selected, it is possible to quickly switch to the integration means corresponding to the cross gradient. Thus, in the steering device, an appropriate steering torque can be applied in accordance with the crossing gradient, and the accuracy with which the vehicle travels along the predetermined position can be improved.

本発明によれば、横断勾配に応じた適切な操舵トルクを付与することでき、車両を走行路の所定位置に沿って高精度に走行させることができる。   ADVANTAGE OF THE INVENTION According to this invention, the appropriate steering torque according to a crossing gradient can be provided, and a vehicle can be drive | worked with high precision along the predetermined position of a driving path.

以下、図面を参照して、本発明に係る操舵装置の実施の形態を説明する。   Hereinafter, embodiments of a steering apparatus according to the present invention will be described with reference to the drawings.

本実施の形態では、本発明に係る操舵装置を、レーンキープ装置に適用する。本発明に係るレーンキープ装置は、ドライバによる操舵を支援するために、カメラによる撮像画像から白線を認識し、左右の白線(車線)の中央側への補助的な操舵トルクを付与する。   In the present embodiment, the steering device according to the present invention is applied to a lane keeping device. The lane keeping device according to the present invention recognizes a white line from an image captured by a camera and assists steering by a driver, and applies an auxiliary steering torque toward the center of left and right white lines (lanes).

図1〜図4を参照して、本実施の形態に係るレーンキープ装置1について説明する。図1は、本実施の形態に係るレーンキープ装置の構成図である。図2は、本実施の形態に係るレーンキープ装置の制御ブロック図である。図3は、オフセット閾値1の値の切替処理の説明図であり、(a)が直線であり、(b)がカーブである。図4は、誤選択の積分の修正処理の説明図である。   A lane keeping device 1 according to the present embodiment will be described with reference to FIGS. FIG. 1 is a configuration diagram of a lane keeping device according to the present embodiment. FIG. 2 is a control block diagram of the lane keeping device according to the present embodiment. FIG. 3 is an explanatory diagram of the process of switching the value of the offset threshold 1, where (a) is a straight line and (b) is a curve. FIG. 4 is an explanatory diagram of an erroneous selection integration correction process.

レーンキープ装置1は、車線の中央の走行を補助するために必要な目標操舵トルクを設定し、電動パワーステアリング装置によりその目標操舵トルクを付与する。その際、レーンキープ装置1では、カーブ曲率、白線に対する車両の向き(ヨー角)、車線中心に対する車両位置の偏差(オフセット)及びそのオフセットの時間積分値に基づいて目標操舵トルクを設定する。特に、レーンキープ装置1では、オフセットの積分値として車線中心に対して右側分のオフセットの積分値と左側分のオフセットの積分値とを別々に求め、右積分と左積分を切り替えて一方の積分値に基づいて目標操舵トルクを設定する。レーンキープ装置1は、白線認識センサ2及びレーンキープECU[Electronic ControlUnit]3を備えており、電動パワーステアリング装置10を利用する。白線認識センサ2は、撮像手段としてのカメラ2a及び白線認識ECU2bによって構成される。なお、カーブ曲率はカーブ半径の逆数なので、カーブ曲率をカーブ半径の逆数で代用することも可能である。   The lane keeping device 1 sets a target steering torque necessary for assisting traveling in the center of the lane, and applies the target steering torque by the electric power steering device. At that time, the lane keeping device 1 sets the target steering torque based on the curve curvature, the vehicle direction (yaw angle) with respect to the white line, the deviation (offset) of the vehicle position with respect to the lane center, and the time integral value of the offset. In particular, in the lane keeping device 1, the integral value of the offset for the right side and the integral value of the offset for the left side with respect to the lane center are separately obtained as the integral value of the lane, and one integration is performed by switching the right integration and the left integration. A target steering torque is set based on the value. The lane keeping device 1 includes a white line recognition sensor 2 and a lane keeping ECU [Electronic Control Unit] 3, and uses an electric power steering device 10. The white line recognition sensor 2 includes a camera 2a as an imaging unit and a white line recognition ECU 2b. Since the curve curvature is the reciprocal of the curve radius, the curve curvature can be substituted with the reciprocal of the curve radius.

電動パワーステアリング装置10は、EPS[Electronic Power Steering]ECU10aによってEPSモータ10bを制御し、EPSモータ10bによる駆動トルクによりドライバによる操舵をアシストする。EPSECU10aでは、図2に示すように、ドライバの操舵による操舵トルクに基づいてアシストトルクを設定し、そのアシストトルクに応じてEPSモータ10bを駆動制御する。特に、EPSECU10aでは、レーンキープECU3からの操舵トルク信号TSを受信すると、その操舵トルク信号TSに示される目標操舵トルクに所定の係数を乗算し、その乗算値(付加トルク)をアシストトルクに加算し、そのアシストトルク+付加トルクに応じてEPSモータ10bを駆動制御する。EPSモータ10bによる駆動トルクは操舵機構に付加され、操舵機構にはドライバによる操舵トルク以外にEPSモータ10bによるトルクが加わる。付加トルクは、ドライバによる操舵トルクを補助する程度の比較的小さなトルクである。   The electric power steering device 10 controls the EPS motor 10b by an EPS [Electronic Power Steering] ECU 10a, and assists the steering by the driver with the driving torque of the EPS motor 10b. As shown in FIG. 2, the EPS ECU 10a sets an assist torque based on the steering torque generated by the driver's steering, and drives and controls the EPS motor 10b according to the assist torque. In particular, when the EPSECU 10a receives the steering torque signal TS from the lane keep ECU 3, the EPS ECU 10a multiplies the target steering torque indicated by the steering torque signal TS by a predetermined coefficient, and adds the multiplied value (additional torque) to the assist torque. The EPS motor 10b is driven and controlled according to the assist torque + addition torque. Driving torque by the EPS motor 10b is added to the steering mechanism, and torque by the EPS motor 10b is applied to the steering mechanism in addition to the steering torque by the driver. The additional torque is a relatively small torque that assists the steering torque by the driver.

カメラ2aは、例えば、CCD[Charge Coupled Device]カメラであり、レーンキープ装置1を搭載する車両の前方に取り付けられる。この際、カメラ2aは、その光軸方向が車両の進行方向と一致するように取り付けられる。カメラ2aでは、車両の前方の道路を撮像し、その撮像したカラー画像(例えば、RGB[RedGreen Blue]による画像)を取得する。カメラ2aでは、その撮像画像のデータを撮像信号PSとして白線認識ECU2bに送信する。カメラ2aは、左右方向に撮像範囲が広く、走行している車線を示す左右両側(一対)の白線を十分に撮像可能である。なお、カメラ2aはカラーであるが、道路上の白線を認識できる画像を取得できればよいので、白黒のカメラでもよい。   The camera 2a is, for example, a CCD [Charge Coupled Device] camera, and is attached to the front of the vehicle on which the lane keeping device 1 is mounted. At this time, the camera 2a is attached so that the optical axis direction thereof coincides with the traveling direction of the vehicle. The camera 2a captures a road ahead of the vehicle and acquires a captured color image (for example, an image of RGB [RedGreen Blue]). The camera 2a transmits the captured image data to the white line recognition ECU 2b as an imaging signal PS. The camera 2a has a wide imaging range in the left-right direction, and can sufficiently capture the white lines on both the left and right sides (a pair) indicating the traveling lane. Although the camera 2a is colored, it may be a black and white camera as long as it can acquire an image that can recognize a white line on the road.

白線認識ECU2bは、CPU[Central Processing Unit]、ROM[Read Only Memory]、RAM[Random AccessMemory]などからなる。白線認識ECU2bでは、撮像信号PSを取り入れ、撮像信号PSの撮像画像データから車両が走行している車線を示す一対の白線を認識する。そして、白線認識ECU2bでは、認識した一対の白線から車線幅、一対の白線の中心を通る線(すなわち、車線の中心)を演算する。さらに、白線認識ECU2bでは、車線の中心の半径(カーブ半径R)を演算し、カーブ半径Rからカーブ曲率γ(=1/R)を演算する。また、白線認識ECU2bでは、白線に対するに対する車両の向き(ヨー角θ)及び車線の中心に対する車両中心の位置(オフセットD)を演算する。そして、白線認識ECU2bでは、これら認識した一対の白線の情報や演算した各情報を画像信号GSとしてレーンキープECU3に送信する。なお、本実施の形態では、カーブ半径R、曲率γ、ヨー角θ、オフセットDは、右旋回方向や車線中心に対して右側の値がプラス値で表され、左旋回方向や車線中心に対して左側の値がマイナス値で表されるものとする。   The white line recognition ECU 2b includes a CPU [Central Processing Unit], a ROM [Read Only Memory], a RAM [Random Access Memory], and the like. The white line recognition ECU 2b takes in the imaging signal PS and recognizes a pair of white lines indicating the lane in which the vehicle is traveling from the captured image data of the imaging signal PS. Then, the white line recognition ECU 2b calculates a lane width and a line passing through the center of the pair of white lines (that is, the center of the lane) from the recognized pair of white lines. Further, the white line recognition ECU 2b calculates the radius of the lane center (curve radius R), and calculates the curve curvature γ (= 1 / R) from the curve radius R. Further, the white line recognition ECU 2b calculates the vehicle direction (yaw angle θ) with respect to the white line and the position of the vehicle center (offset D) with respect to the center of the lane. Then, the white line recognition ECU 2b transmits the information of the recognized pair of white lines and the calculated information to the lane keep ECU 3 as an image signal GS. In the present embodiment, the curve radius R, the curvature γ, the yaw angle θ, and the offset D are expressed as positive values on the right side with respect to the right turn direction or the lane center, and the left turn direction or the lane center. On the other hand, it is assumed that the value on the left side is expressed as a negative value.

レーンキープECU3は、CPU、ROM、RAMなどからなる。レーンキープECU3では、一定時間毎に、白線認識センサ2からの画像信号GSを取り入れる。そして、レーンキープECU3では、ドライバによる操作によってレーンキープ装置1が起動されている場合、車両が車線の中央付近を走行するように、画像信号GSに示される各種情報(カーブ曲率γ、ヨー角θ、オフセットD)に基づいて目標操舵トルクを設定し、目標操舵トルクを示す操舵トルク信号TSを電動パワーステアリング装置10(EPSECU10a)に送信する。なお、レーンキープECU3ではレーンキープ処理用のアプリケーションプログラム(ソフトウエア)を実行することによって各種処理(右積分処理、左積分処理、積分切替処理、目標操舵トルク設定処理など)を行うが、この各種処理が特許請求の範囲に記載する第1積分手段、第2積分手段、切替手段、操舵トルク設定手段に相当する。   The lane keep ECU 3 includes a CPU, a ROM, a RAM, and the like. The lane keep ECU 3 takes in the image signal GS from the white line recognition sensor 2 at regular intervals. Then, in the lane keeping ECU 3, when the lane keeping device 1 is activated by an operation by the driver, various information (curve curvature γ, yaw angle θ) indicated by the image signal GS so that the vehicle travels near the center of the lane. The target steering torque is set based on the offset D), and a steering torque signal TS indicating the target steering torque is transmitted to the electric power steering apparatus 10 (EPS ECU 10a). The lane keep ECU 3 executes various processing (right integration processing, left integration processing, integration switching processing, target steering torque setting processing, etc.) by executing an application program (software) for lane keeping processing. The processing corresponds to first integration means, second integration means, switching means, and steering torque setting means described in the claims.

図2に示すように、レーンキープECU3では、一定時間毎に、オフセットDを用いて右積分処理と左積分処理を行い、右積分値RI及び左積分値LIを求める。そして、レーンキープECU3では、一定時間毎に、積分切替処理により右積分値RIと左積分値LIとの切り替えを行い、目標操舵トルク設定処理で用いる積分値を選択する。さらに、レーキキープECU3では、一定時間毎に、目標操舵トルク設定処理により、カーブ曲率γにゲインG1を乗算し、ヨー角θにゲインG2を乗算し、オフセットDにゲインG3を乗算し、選択した積分値にゲインG4を乗算し、各ゲインG1〜G4を乗算したカーブ曲率γ、ヨー角θ、オフセットD、オフセットの積分値に基づいて目標操舵トルクを設定する。ここでは、カーブ曲率γについては車両を道路のカーブに沿わせ、ヨー角θについてはヨー角を0に収束させ、オフセットDについてはオフセットDを0に収束させ、オフセット積分値については積分値をサチュレートさせるような目標操舵トルクが設定される。なお、右積分処理と左積分処理及び右積分と左積分との積分切替処理については、以下で詳細に説明する。   As shown in FIG. 2, the lane keep ECU 3 performs the right integration process and the left integration process using the offset D at regular intervals to obtain the right integration value RI and the left integration value LI. The lane keep ECU 3 switches between the right integral value RI and the left integral value LI by the integral switching process at regular intervals, and selects the integral value used in the target steering torque setting process. Further, the rake keep ECU 3 multiplies the curve curvature γ by the gain G1, multiplies the yaw angle θ by the gain G2, and multiplies the offset D by the gain G3 by a target steering torque setting process at a fixed time interval. The value is multiplied by the gain G4, and the target steering torque is set based on the curve curvature γ, the yaw angle θ, the offset D, and the integrated value of the offset multiplied by the gains G1 to G4. Here, for the curve curvature γ, the vehicle follows the road curve, for the yaw angle θ, the yaw angle converges to 0, for the offset D, the offset D converges to 0, and for the offset integral value, the integral value is set. A target steering torque that saturates is set. The right integration process and the left integration process, and the integration switching process between the right integration and the left integration will be described in detail below.

右積分処理と左積分処理について説明する。レーンキープECU3では、一定時間毎に入力されるオフセットDを車線中心に対する右側分についての時間積分(右積分処理)と左側分についての時間積分(左積分処理)を行う。オフセットDは、上記したように、車線中心に対して車両位置が右側の場合にはプラス値、車両位置が左側の場合にはマイナス値で表される。この場合、右積分処理では、オフセットDを時間積分し、その積分値が0より大きい場合にはその積分値をそのまま出力し、積分値が0以下の場合には0を出力する。したがって、右積分の出力値(右積分値)は、オフセットDが0より大きい場合には増加し、オフセットDが0の場合には変化せず、オフセットDが0より小さい場合には0を下限として減少する。左積分処理では、オフセットDを時間積分し、その積分値が0より小さい場合にはその積分値をそのまま出力し、積分値が0以上の場合には0を出力する。したがって、左積分の出力値(左積分値)は、オフセットDが0より小さい場合には減少(絶対値は増加)し、オフセットDが0の場合には変化せず、オフセットDが0より大きい場合には0を上限として増加する(絶対値は0を下限として減少する)。なお、オフセットDが車線中心に対して車両位置が右側の場合にはマイナス値、車両位置が左側の場合にはプラス値で表される場合、右積分、左積分では、プラスとマイナスの関係が上記と逆になる。   The right integration process and the left integration process will be described. The lane keep ECU 3 performs time integration (right integration processing) on the right side of the lane center and time integration (left integration processing) on the left side with respect to the offset D input at regular intervals. As described above, the offset D is expressed as a positive value when the vehicle position is on the right side with respect to the lane center, and as a negative value when the vehicle position is on the left side. In this case, in the right integration process, the offset D is time-integrated. If the integral value is larger than 0, the integral value is output as it is, and if the integral value is 0 or less, 0 is output. Therefore, the right integration output value (right integration value) increases when the offset D is greater than 0, does not change when the offset D is 0, and lowers 0 when the offset D is less than 0. As it decreases. In the left integration process, the offset D is time integrated, and if the integral value is smaller than 0, the integral value is output as it is, and if the integral value is 0 or more, 0 is output. Accordingly, the output value (left integral value) of the left integration decreases (the absolute value increases) when the offset D is smaller than 0, does not change when the offset D is 0, and the offset D is larger than 0. In this case, the value increases with 0 as the upper limit (the absolute value decreases with 0 as the lower limit). When the offset D is expressed as a negative value when the vehicle position is on the right side with respect to the lane center and as a positive value when the vehicle position is on the left side, there is a relationship between positive and negative in the right integration and left integration. The reverse of the above.

積分切替処理について説明する。まず、レーンキープECU3では、カーブ半径Rの絶対値がカーブ判定閾値Rより大きいか否かを判定する。カーブ判定閾値Rは、直線(ほぼ直線も含む)かあるいはカーブかを判定する閾値であり、大きな値である。 The integration switching process will be described. First, the lane keep ECU 3 determines whether or not the absolute value of the curve radius R is larger than the curve determination threshold value R0 . The curve determination threshold value R 0 is a threshold value for determining whether the curve is a straight line (including almost a straight line) or a curve, and is a large value.

カーブ半径Rの絶対値がカーブ判定閾値Rより大きいと判定した場合(直線の場合)、レーンキープECU3では、オフセット閾値1としてオフセットDを設定する。オフセットDは、横断勾配の影響などによって車両のオフセットDの絶対値が大きくなり、オフセットDが大きくなった側の積分値に切り替える必要があるか否かを判定するための閾値であり、直線で用いられる閾値である。図3(a)には、両側の白線WL,WL、車線の中心線CLを示しており、直線の場合、中心線CLから両側にそれぞれ、オフセットD分のオフセット閾値1が設定される。 The absolute value of the curve radius R (in the case of a straight line) when it is determined that the curve is greater than the determination threshold value R 0, the lane keeping ECU 3, sets the offset D 0 as offset threshold 1. The offset D 0 is a threshold value for determining whether or not it is necessary to switch to an integral value on the side where the offset D becomes large because the absolute value of the offset D of the vehicle becomes large due to the influence of the crossing gradient or the like. Is a threshold value used in. FIG. 3A shows the white lines WL, WL on both sides and the center line CL of the lane. In the case of a straight line, an offset threshold 1 of offset D 0 is set on each side of the center line CL.

カーブ半径Rの絶対値がカーブ判定閾値R以下の場合(カーブの場合)、レーンキープECU3では、オフセット閾値1としてオフセットDを設定する。オフセットDは、オフセットDより大きな値が設定され、カーブ走行中に積分値の切り替わりを抑制するための閾値であり、カーブで用いられる閾値である。ちなみに、車両のオフセットDの絶対値がオフセットDより大きくなった場合、車両が車線中心から相当ずれているので、カーブ中でもオフセットDが大きくなった側の積分値に切り替える必要がある。図3(b)には、カーブの場合、中心線CLから両側にそれぞれ、オフセットDより大きいオフセットD分のオフセット閾値1が設定される。 The absolute value of the curve radius R (in the case of the curve) when: the curve judgment threshold R 0, the lane keeping ECU 3, sets the offset D 1 as the offset threshold 1. The offset D 1 is set to a value larger than the offset D 0 and is a threshold value for suppressing the switching of the integral value during the curve traveling, and is a threshold value used in the curve. Incidentally, when the absolute value of the offset D of the vehicle is greater than the offset D 1, the vehicle since the corresponding deviation from the lane center, it is necessary to switch to the integral value of the side of the offset D is large even in the curve. In FIG. 3B, in the case of a curve, an offset threshold value 1 for an offset D 1 greater than the offset D 0 is set on both sides from the center line CL.

現在選択中の積分が左積分の場合、レーンキープECU3では、右側オフセット(オフセットDのプラス値の絶対値)がオフセット閾値1の絶対値より大きいか否かを判定する。右側オフセットがオフセット閾値1の絶対値より大きい場合、レーンキープECU3では、左積分から右積分に切り替える。この場合、横断勾配の影響などによって車線中心から右側へのずれが大きくなったので、右積分値に切り替えて、右側から左側に向けた操舵トルクを付加するようにする。   When the currently selected integral is the left integral, the lane keep ECU 3 determines whether or not the right offset (the absolute value of the plus value of the offset D) is larger than the absolute value of the offset threshold value 1. When the right offset is larger than the absolute value of the offset threshold 1, the lane keep ECU 3 switches from left integration to right integration. In this case, since the deviation from the lane center to the right side is increased due to the influence of the crossing gradient, the steering torque is applied from the right side to the left side by switching to the right integral value.

右側オフセットがオフセット閾値1の絶対値以下の場合、レーンキープECU3では、左積分値が0か否か(つまり、左側の積分の影響が無くなったか否か)を判定する。左積分値が0の場合、レーンキープECU3では、右側オフセットがオフセット閾値2の絶対値より大きいか否かを判定する。オフセット閾値2は、カーブ走行中に誤選択されている積分値の切り替えを可能とするために、オフセット閾値1(=オフセットD)より小さい値が設定される。オフセット閾値2としては、オフセットDが設定され、オフセットDはオフセットDと同じかあるいはD近傍の値である。図4には、中心線CLから両側にそれぞれ、オフセットDの近傍にオフセットD分のオフセット閾値2が設定される。右側オフセットがオフセット閾値2の絶対値より大きい場合、レーンキープECU3では、左積分から右積分に切り替える。この場合、右方向へのカーブに進入したにもかかわらず左積分が選択されているので、右積分に切り替えて、右側から左側に向けた操舵トルクを付加するようにする。ここでは、左積分値が0になり、左積分値による影響が無くなっているときには、右積分に切り替える。さらに、オフセット閾値1より小さいオフセット閾値2を設定することによって、車両位置も考慮して切り替えを行うことができる。 When the right offset is less than or equal to the absolute value of the offset threshold 1, the lane keep ECU 3 determines whether or not the left integrated value is 0 (that is, whether or not the influence of the left integration has been eliminated). When the left integrated value is 0, the lane keep ECU 3 determines whether or not the right offset is larger than the absolute value of the offset threshold value 2. The offset threshold value 2 is set to a value smaller than the offset threshold value 1 (= offset D 1 ) in order to enable switching of an integration value that is erroneously selected during curve traveling. The offset threshold 2 are set offset D 2 is the offset D 2 is the value of the same or D 0 near the offset D 0. 4 shows, on each side from the center line CL, offset threshold 2 offset D 2 minutes is set in the vicinity of the offset D 0. When the right offset is larger than the absolute value of the offset threshold 2, the lane keep ECU 3 switches from left integration to right integration. In this case, since the left integration is selected even though the vehicle enters the curve in the right direction, the steering torque is applied from the right side to the left side by switching to the right integration. Here, when the left integral value becomes 0 and the influence of the left integral value is eliminated, the right integral is switched. Furthermore, by setting an offset threshold 2 smaller than the offset threshold 1, switching can be performed in consideration of the vehicle position.

現在選択中の積分が右積分の場合、レーンキープECU3では、左側オフセット(オフセットDのマイナス値の絶対値)がオフセット閾値1の絶対値より大きいか否かを判定する。左側オフセットがオフセット閾値1の絶対値より大きい場合、レーンキープECU3では、右積分から左積分に切り替える。この場合、横断勾配の影響などによって車線中心から左側へのずれが大きくなったので、左積分値に切り替えて、左側から右側に向けた操舵トルクを付加するようにする。   When the currently selected integration is a right integration, the lane keep ECU 3 determines whether the left offset (the absolute value of the minus value of the offset D) is larger than the absolute value of the offset threshold value 1. When the left offset is larger than the absolute value of the offset threshold 1, the lane keep ECU 3 switches from right integration to left integration. In this case, since the deviation from the lane center to the left side is increased due to the influence of the crossing gradient, the steering torque is applied from the left side to the right side by switching to the left integrated value.

左側オフセットがオフセット閾値1の絶対値以下の場合、レーンキープECU3では、右積分値が0か否か(つまり、右側の積分の影響が無くなったか否か)を判定する。右積分値が0の場合、レーンキープECU3では、左側オフセットがオフセット閾値2の絶対値より大きいか否かを判定する。左側オフセットがオフセット閾値2の絶対値より大きい場合、レーンキープECU3では、右積分から左積分に切り替える。この場合、左方向へのカーブに進入したにもかかわらず右積分が選択されているので、左積分に切り替えて、左側から右側に向けた操舵トルクを付加するようにする。ここでは、右積分値が0になり、右積分値による影響が無くなっているときには、左積分に切り替える。さらに、オフセット閾値1より小さいオフセット閾値2を設定することによって、車両位置も考慮して切り替えを行うことができる。   When the left offset is equal to or smaller than the absolute value of the offset threshold 1, the lane keep ECU 3 determines whether the right integral value is 0 (that is, whether the influence of the right integration has been eliminated). When the right integral value is 0, the lane keep ECU 3 determines whether the left offset is larger than the absolute value of the offset threshold value 2. When the left offset is larger than the absolute value of the offset threshold 2, the lane keep ECU 3 switches from right integration to left integration. In this case, since right integration is selected even though the vehicle has entered the curve in the left direction, switching to left integration is performed so that steering torque from the left side to the right side is added. Here, when the right integration value is 0 and the influence of the right integration value is eliminated, the left integration value is switched. Furthermore, by setting an offset threshold 2 smaller than the offset threshold 1, switching can be performed in consideration of the vehicle position.

カーブでは、通常、カーブ外側が高く、内側が低い向きの横断勾配となっており、カーブ途中で横断勾配の向きは変わらない。したがって、カーブ走行中には、常に、横断勾配による車両に作用する重力成分に対抗するために、カーブ内側の積分値を選択し、カーブの内側から外側に向けた操舵トルクを付加することが望ましい。また、カーブ走行中に、カーブ内側の積分値からカーブ外側の積分値に切り替わると、重力成分の方向と同じ方向であるカーブの外側から内側に向けた操舵トルクが付加されることになり、車両が内側に向けて大きく変動し、ドライバに対する操舵反力も大きくなる。そこで、レーンキープECU3では、カーブの場合、オフセット閾値1を大きくし、左積分と右積分が切り替わらないようにしている。   A curve usually has a cross slope with a high outside and a low inside, and the direction of the cross slope does not change during the curve. Therefore, it is desirable to always select an integral value inside the curve and apply a steering torque from the inside to the outside of the curve in order to counter the gravitational component acting on the vehicle due to the crossing gradient while driving on the curve. . In addition, if the integral value inside the curve is switched to the integral value outside the curve while driving on the curve, a steering torque directed from the outside to the inside of the curve, which is the same direction as the direction of the gravity component, is added. Fluctuates inward and the steering reaction force against the driver also increases. Therefore, in the case of a curve, the lane keep ECU 3 increases the offset threshold 1 so that the left integration and the right integration are not switched.

図3(b)の例では、横断勾配の向きが、直線のときから道路左側が高く、右側が低い向きであり、カーブに入っても変わらない場合である。そのため、カーブに進入する前の直線のときから、右積分値が選択されており、道路の右側から左側に向けた操舵トルクが付加されていた。したがって、カーブ進入後、車両のオフセットDの軌跡RLが、車線中心線CLをまたいで、右側から左側になっている。オフセット閾値1がオフセットDの場合、左側オフセットがオフセットDを超えてしまい、左積分値に切り替わり、左側から右側に向けた操舵トルクが付加されることになる。すると、この操舵トルクが付加される方向と横断勾配による重力成分の方向とが同じ方向となり、車両が急激に道路右側に変動し、車両のオフセットDの軌跡RL’も急激に変化する。しかし、レーンキープECU3では、オフセット閾値1を大きなオフセットDとしているので、左側オフセットがオフセットDを超えることはなく、右積分値の選択が維持され、右側から左側に向けた操舵トルクが付加され続ける。この場合、この操舵トルクが付加される方向と横断勾配による重力成分の方向とが逆方向となっているので、車両の変動が少なく、車両のオフセットDの軌跡RLも中心線CLの近傍となる。 In the example of FIG. 3B, the direction of the crossing gradient is a direction where the left side of the road is higher and the right side is lower than when it is a straight line, and it does not change even when entering a curve. Therefore, since the straight line before entering the curve, the right integral value has been selected, and steering torque from the right side to the left side of the road has been added. Therefore, after entering the curve, the locus RL of the offset D of the vehicle is from the right side to the left side across the lane center line CL. When the offset threshold 1 is the offset D 0 , the left offset exceeds the offset D 0 , and the left integrated value is switched, and a steering torque from the left to the right is added. Then, the direction in which the steering torque is applied is the same as the direction of the gravity component due to the cross gradient, the vehicle suddenly changes to the right side of the road, and the locus RL ′ of the vehicle offset D also changes abruptly. However, the lane-keep ECU 3, since the offset threshold 1 and large offset D 1, never left offset exceeds the offset D 1, the selection of the right integrated value is maintained, the additional steering torque directed from right to left Continue to be. In this case, since the direction in which the steering torque is applied and the direction of the gravity component due to the cross gradient are opposite, the vehicle is less fluctuating and the locus RL of the offset D of the vehicle is also near the center line CL. .

上記したように、レーンキープECU3では、カーブの場合にはオフセット閾値1(=オフセットD)を大きくして左積分と右積分が切り替わらないようにしている。しかし、S字カーブや直線からカーブになるときには、カーブ(以下、現カーブと記載する)に入ると横断勾配の方向が急に変わる場合があり、車両に作用する重力成分の方向が変化する。この場合、現カーブに進入する前には、現カーブの横断勾配とは逆方向の横断勾配の影響により、現カーブの外側から内側に向けた操舵トルクが付加されている。現カーブの外側から内側に向けた操舵トルクは、現カーブに進入した場合には、車両に作用する重力成分と同じ方向となる。そのため、現カーブに進入した場合には、重力成分に対抗するために現カーブの内側から外側に向けた操舵トルクを付加するために、現カーブの外側の積分値から内側の積分値に切り替える必要がある。しかし、カーブではオフセット閾値1が大きいため、現カーブ内側のオフセットがオフセット閾値1を超えるまで時間を要し、車両の位置も車線中心から大きくずれることになる。そこで、現カーブ内側のオフセットがオフセット閾値1の絶対値以下でも、その現カーブの外側の積分値が0になり(つまり、その積分値の影響力がなくなり)、現カーブ内側のオフセットがオフセット閾値1より小さいオフセット閾値2より大きくなった場合、現カーブの外側の積分値から内側の積分値への切り替えを可能としている。 As described above, the lane keep ECU 3 increases the offset threshold 1 (= offset D 1 ) in the case of a curve so that the left integration and the right integration are not switched. However, when changing from an S-shaped curve or a straight line to the curve (hereinafter referred to as the current curve), the direction of the transverse gradient may change suddenly, and the direction of the gravity component acting on the vehicle changes. In this case, before entering the current curve, steering torque is applied from the outside to the inside of the current curve due to the influence of the cross gradient in the direction opposite to the cross gradient of the current curve. The steering torque directed from the outside to the inside of the current curve is in the same direction as the gravity component acting on the vehicle when entering the current curve. Therefore, when entering the current curve, it is necessary to switch from the integral value outside the current curve to the integral value inside to add the steering torque from the inside to the outside of the current curve to counter the gravity component. There is. However, since the offset threshold value 1 is large in the curve, it takes time until the offset inside the current curve exceeds the offset threshold value 1, and the vehicle position also deviates greatly from the lane center. Therefore, even if the offset inside the current curve is less than or equal to the absolute value of the offset threshold 1, the integral value outside the current curve becomes 0 (that is, the influence of the integral value disappears), and the offset inside the current curve becomes the offset threshold value. When the offset threshold value is smaller than 1, the integral value outside the current curve can be switched to the integral value inside.

図4の例では、横断勾配の向きが、直線のときは道路左側が低く、右側が高い向きであり、カーブのときには道路左側が高く、右側が低い向きの場合である。そのため、カーブに進入する前の直線では、左積分値が選択されており、道路の左側から右側に向けた操舵トルクが付加されていた。この状態で、カーブに進入すると、車両には、付加されている操舵トルクと同じ方向の道路の左側から右側に向けた重力成分が作用する。その結果、車両が、急激に道路右側に移動する。この際、カーブになったので、オフセット閾値1が大きなオフセットDとなっている。このオフセット閾値1だけで切り替え判定を行った場合、右側オフセットがオフセットDをなかなか超えないので、左積分値から右積分値に切り替わらず、左側から右側に向けた操舵トルクが付加され続ける。したがって、この操舵トルクが付加される方向と横断勾配による重力成分の方向とが同じ方向となっているので、車両が急激な道路右側への変動も続き、車両のオフセットDの軌跡RL’も急激に変化する。この状態が、右側オフセットがオフセットDを超えるまで続く。しかし、レーンキープECU3では、左積分値が0になったか否かを判定し、左積分が0になっている場合には左積分値から右積分値に切り替え、右側から左側に向けた操舵トルクを付加し始める。この際、レーンキープECU3では、車両位置も考慮して切り替えを行うために、オフセット閾値1より小さいオフセット閾値2(=オフセットD)での判定も行う。このように、左積分値による影響が無くなっている場合には右側から左側に向けた操舵トルクを付加するように右積分値に切り替えることによって、この操舵トルクが付加される方向と横断勾配による重力成分の方向とが逆方向となるので、車両の変動が少なく、車両のオフセットDの軌跡RLも中心線CLの近傍となる。 In the example of FIG. 4, when the direction of the cross slope is a straight line, the left side of the road is low and the right side is high. When the curve is a curve, the left side of the road is high and the right side is low. Therefore, the left integrated value is selected on the straight line before entering the curve, and the steering torque from the left side to the right side of the road is added. When entering the curve in this state, a gravity component from the left side to the right side of the road in the same direction as the applied steering torque acts on the vehicle. As a result, the vehicle suddenly moves to the right side of the road. At this time, since became curve, it has offset threshold 1 is a large offset D 1. When performing the switching judgment at this offset threshold 1, the right offset does not easily exceed the offset D 1, not switched from left integral value to the right the integral value, it continues to be added steering torque directed from left to right. Therefore, since the direction in which the steering torque is applied and the direction of the gravity component due to the cross gradient are the same direction, the vehicle continues to fluctuate to the right side of the road, and the locus RL ′ of the offset D of the vehicle also increases abruptly. To change. This state continues until the right offset exceeds the offset D 1. However, the lane keep ECU 3 determines whether or not the left integral value has become 0, and when the left integral has become 0, the left integral value is switched to the right integral value, and the steering torque from the right side to the left side is determined. Start adding. At this time, the lane keep ECU 3 also performs determination with an offset threshold 2 (= offset D 2 ) smaller than the offset threshold 1 in order to perform switching in consideration of the vehicle position. In this way, when the influence of the left integrated value is eliminated, switching to the right integrated value so as to add the steering torque from the right side to the left side, the direction in which this steering torque is applied and the gravity due to the cross gradient Since the direction of the component is opposite, there is little fluctuation of the vehicle, and the locus RL of the offset D of the vehicle is also near the center line CL.

図1及び図2を参照して、レーンキープ装置1の動作について説明する。特に、レーンキープECU3における積分切替処理については図5のフローチャートに沿って説明する。図5は、図1のレーンキープECUにおける積分切替処理の流れを示すフローチャートである。ここでは、ドライバによってレーンキープ装置1が起動されている場合について説明する。   The operation of the lane keeping device 1 will be described with reference to FIGS. 1 and 2. In particular, the integration switching process in the lane keep ECU 3 will be described with reference to the flowchart of FIG. FIG. 5 is a flowchart showing the flow of integral switching processing in the lane keeping ECU of FIG. Here, a case where the lane keeping device 1 is activated by the driver will be described.

カメラ2aでは、車両の前方の道路を撮像し、その撮像画像のデータを撮像信号PSとして白線認識ECU2bに送信する。白線認識ECU2bでは、撮像画像から車線を区画する一対の白線を認識する。そして、白線認識ECU2bでは、一対の白線から車線幅、車線の中心、車線中心のカーブ半径Rと曲率γ、ヨー角θ及び車線中心からの車両のオフセットDを演算する。さらに、白線認識ECU2bでは、一定時間毎に、これら一対の白線の情報や演算した各情報を画像信号GSとしてレーンキープECU3に送信する。   The camera 2a captures an image of a road ahead of the vehicle and transmits data of the captured image to the white line recognition ECU 2b as an image signal PS. The white line recognition ECU 2b recognizes a pair of white lines that divide the lane from the captured image. Then, the white line recognition ECU 2b calculates the lane width, the lane center, the curve radius R and curvature γ, the yaw angle θ, and the vehicle offset D from the lane center from the pair of white lines. Further, the white line recognition ECU 2b transmits the information of the pair of white lines and each calculated information to the lane keep ECU 3 as an image signal GS at regular time intervals.

レーンキープECU3では、一定時間毎に、画像信号GSを受信する。そして、レーンキープECU3では、画像信号GSからカーブ半径R、曲率γ、ヨー角θ、オフセットDを取得する(S1、S2)。レーンキープECU3では、オフセットDを取得する毎に、右積分処理により右積分値を演算するとともに左積分処理により左積分値を演算する。また、レーンキープECU3では、カーブ半径Rの絶対値がカーブ判定閾値Rより大きいか否かを判定する(S3)。S3にてカーブ半径Rの絶対値がカーブ判定閾値Rより大きいと判定した場合(直線の場合)、レーンキープECU3では、オフセット閾値1にオフセットDを設定する(S4)。したがって、直線の場合、オフセット閾値1は小さく、車両が車線中心に対してオフセットする側が変わると、右積分と左積分とが切り替わり易くなっている。S3にてカーブ半径Rの絶対値がカーブ判定閾値R以下と判定した場合(カーブの場合)、レーンキープECU3では、オフセット閾値1にオフセットD(>オフセットD)を設定する(S5)。したがって、カーブの場合、オフセット閾値1は大きく、右積分と左積分とが切り替わり難くなっている。さらに、レーンキープECU3では、左積分を選択中か否かを判定する(S6)。 The lane keep ECU 3 receives the image signal GS at regular intervals. Then, the lane keep ECU 3 obtains the curve radius R, the curvature γ, the yaw angle θ, and the offset D from the image signal GS (S1, S2). The lane keep ECU 3 calculates the right integration value by the right integration process and calculates the left integration value by the left integration process every time the offset D is acquired. Further, the lane keep ECU 3 determines whether or not the absolute value of the curve radius R is larger than the curve determination threshold value R0 (S3). If the absolute value of the curve radius R in S3 is determined to be larger than the curve determination threshold R 0 (if linear), the lane keeping ECU 3, sets the offset D 0 to offset threshold 1 (S4). Therefore, in the case of a straight line, the offset threshold 1 is small, and when the vehicle is offset from the lane center, the right integration and the left integration are easily switched. If the absolute value of the curve radius R in S3 is determined as follows curve determination threshold R 0 (if the curve), the lane keeping ECU 3, sets the offset D 1 (> offset D 0) to offset threshold 1 (S5) . Therefore, in the case of a curve, the offset threshold value 1 is large, and it is difficult to switch between right integration and left integration. Further, the lane keep ECU 3 determines whether or not the left integration is being selected (S6).

S6にて左積分を選択中と判定した場合、レーンキープECU3では、車線中心に対して右側のオフセットがオフセット閾値1の絶対値より大きいか否かを判定する(S7)。S7にてオフセット閾値1の絶対値より大きいと判定した場合、レーンキープECU3では、左積分から右積分へ切り替える(S8)。この切り替えは、主に、オフセット閾値1が小さい直線の場合に行われる。   When it is determined in S6 that the left integration is being selected, the lane keep ECU 3 determines whether or not the right offset with respect to the lane center is larger than the absolute value of the offset threshold 1 (S7). When it is determined in S7 that the absolute value of the offset threshold value 1 is larger than the absolute value, the lane keep ECU 3 switches from the left integration to the right integration (S8). This switching is performed mainly in the case of a straight line with a small offset threshold value 1.

一方、S7にてオフセット閾値1の絶対値以下と判定した場合、レーンキープECU3では、左積分の積分値が0か否かを判定する(S9)。S9にて左積分の積分値が0と判定した場合、レーンキープECU3では、右側オフセットがオフセット閾値2の絶対値より大きいか否かを判定する(S10)。この場合、左積分が選択されているにもかかわらず、左積分値が0なので、右カーブにかかわらず、左積分が選択されていると推定される。そこで、右側オフセットがオフセットDより小さいオフセット閾値2の絶対値より大きいか否かを判定している。S10にてオフセット閾値2の絶対値より大きいと判定した場合、レーンキープECU3では、左積分から右積分へ切り替える(S11)。この切り替えは、右カーブのときに左積分が選択されている場合に行われる。S9にて左積分の積分値が0でないと判定した場合またはS10にてオフセット閾値2の絶対値以下と判定した場合、レーンキープECU3では、左積分の選択を続ける。 On the other hand, if it is determined in S7 that the absolute value of the offset threshold 1 is not more than the value, the lane keep ECU 3 determines whether or not the integral value of the left integral is 0 (S9). When it is determined in S9 that the integral value of the left integral is 0, the lane keep ECU 3 determines whether or not the right offset is larger than the absolute value of the offset threshold 2 (S10). In this case, although the left integration is selected, the left integration value is 0, so it is estimated that the left integration is selected regardless of the right curve. Therefore, it is determined whether the right offset is greater than the absolute value of the offset D 1 is smaller than the offset threshold 2. If it is determined in S10 that the absolute value of the offset threshold value 2 is larger, the lane keep ECU 3 switches from left integration to right integration (S11). This switching is performed when left integration is selected for the right curve. If it is determined in S9 that the integration value of the left integration is not 0, or if it is determined in S10 that it is equal to or less than the absolute value of the offset threshold 2, the lane keep ECU 3 continues to select the left integration.

S6にて右積分を選択中と判定した場合、レーンキープECU3では、車線中心に対して左側のオフセットがオフセット閾値1の絶対値より大きいか否かを判定する(S12)。S12にてオフセット閾値1の絶対値より大きいと判定した場合、レーンキープECU3では、右積分から左積分へ切り替える(S13)。この切り替えは、主に、オフセット閾値1が小さい直線の場合に行われる。   When it is determined in S6 that the right integration is being selected, the lane keep ECU 3 determines whether or not the left offset relative to the lane center is larger than the absolute value of the offset threshold 1 (S12). If it is determined in S12 that the absolute value of the offset threshold value 1 is larger, the lane keep ECU 3 switches from right integration to left integration (S13). This switching is performed mainly in the case of a straight line with a small offset threshold value 1.

一方、S12にてオフセット閾値1の絶対値以下と判定した場合、レーンキープECU3では、右積分の積分値が0か否かを判定する(S14)。S14にて右積分の積分値が0と判定した場合、レーンキープECU3では、左側オフセットがオフセット閾値2の絶対値より大きいか否かを判定する(S15)。この場合、右積分が選択されているにもかかわらず、右積分値が0なので、左カーブにかかわらず、右積分が選択されていると推定される。そこで、左側オフセットがオフセットDより小さいオフセット閾値2の絶対値より大きいか否かを判定している。S15にてオフセット閾値2の絶対値より大きいと判定した場合、レーンキープECU3では、右積分から左積分へ切り替える(S16)。この切り替えは、左カーブのときに右積分が選択されている場合に行われる。S14にて右積分の積分値が0でないと判定した場合またはS15にてオフセット閾値2の絶対値以下と判定した場合、レーンキープECU3では、右積分の選択を続ける。 On the other hand, if it is determined in S12 that the absolute value of the offset threshold value 1 or less, the lane keep ECU 3 determines whether or not the integration value of the right integration is 0 (S14). If it is determined in S14 that the right integration value is 0, the lane keep ECU 3 determines whether the left offset is larger than the absolute value of the offset threshold 2 (S15). In this case, since the right integration value is 0 even though the right integration is selected, it is estimated that the right integration is selected regardless of the left curve. Therefore, it is determined whether the left offset is greater than the absolute value of the offset D 1 is smaller than the offset threshold 2. If it is determined in S15 that the offset threshold value is greater than 2, the lane keep ECU 3 switches from right integration to left integration (S16). This switching is performed when right integration is selected for the left curve. If it is determined in S14 that the integration value of the right integration is not 0, or if it is determined in S15 that it is equal to or less than the absolute value of the offset threshold 2, the lane keep ECU 3 continues to select the right integration.

そして、レーンキープECU3では、カーブ曲率γ、ヨー角θ、オフセットD、選択中の積分値に対してゲインG1,G2,G3,G4をそれぞれ乗算し、その各乗算値に基づいて目標操舵トルクを設定する。そして、レーンキープECU3では、設定した目標操舵トルクを示す操舵トルク信号TSをEPSECU10aに送信する。   The lane keep ECU 3 multiplies the curve curvature γ, the yaw angle θ, the offset D, and the selected integral value by the gains G1, G2, G3, and G4, respectively, and calculates the target steering torque based on each multiplication value. Set. The lane keep ECU 3 transmits a steering torque signal TS indicating the set target steering torque to the EPS ECU 10a.

EPSECU10aでは、操舵トルク信号TSを受信し、その操舵トルク信号TSに示される目標操舵トルクに所定の係数を乗算する。そして、EPSECU10aでは、その乗算値(付加トルク)をアシストトルクに加算し、そのアシストトルク+付加トルクに応じてEPSモータ10bを駆動制御する。EPSモータ10bでは、ECPECU10aによる制御によって所定のトルクを発生し、そのトルクを操舵機構に付加する。すると、操舵機構には、ドライバによる操舵トルクに応じたアシストトルクが加わるとともに、車両を車両中心に沿って走行させるための補助的な付加トルクが加わる。   The EPS ECU 10a receives the steering torque signal TS, and multiplies the target steering torque indicated by the steering torque signal TS by a predetermined coefficient. Then, the EPS ECU 10a adds the multiplication value (additional torque) to the assist torque, and drives and controls the EPS motor 10b according to the assist torque + addition torque. The EPS motor 10b generates a predetermined torque under the control of the ECPECU 10a, and adds the torque to the steering mechanism. Then, an assist torque corresponding to the steering torque by the driver is applied to the steering mechanism, and an auxiliary additional torque for causing the vehicle to travel along the vehicle center is applied.

このレーンキープ装置1によれば、直線とカーブとでオフセット閾値1の値を切り替えることによって、直線では車両のオフセットに応じて適切な側の積分に切り替えることができるとともに、カーブでは積分の切り替えを抑制する。そのため、直線中には横断勾配に応じて適切な方向の操舵トルクを付加することができ、カーブ中には横断勾配に応じて一定方向の操舵トルクを付加し続けることができる。さらに、カーブ中、車両挙動を安定化できるとともに、ドライバに対する操舵反力の変動を抑制できる。   According to this lane keeping device 1, by switching the value of the offset threshold value 1 between the straight line and the curve, the straight line can be switched to the integral on the appropriate side according to the vehicle offset, and the integral switching is switched on the curve. Suppress. Therefore, it is possible to add a steering torque in an appropriate direction according to the crossing gradient in the straight line, and to continue adding a steering torque in a certain direction according to the crossing gradient in the curve. Furthermore, the vehicle behavior can be stabilized during the curve, and the fluctuation of the steering reaction force against the driver can be suppressed.

また、レーンキープ装置1によれば、カーブ中に積分が誤選択されかつオフセットがオフセット閾値1の絶対値以下の場合でも、積分値が0か否かの判定を行うことによって、カーブ中でも横断勾配に応じた適切な積分に切り替えることができる。さらに、レーンキープ装置1では、オフセット閾値1より小さいオフセット閾値2による判定を行うことによって、車両位置も考慮して高精度な切り替えを行うことができる。そのため、カーブ中、車両が車線中心から大きくずれることがなく、車線中心に沿わせるような操舵トルクを付加することができる。   Further, according to the lane keeping device 1, even when the integral is erroneously selected in the curve and the offset is equal to or smaller than the absolute value of the offset threshold 1, it is determined whether the integral value is 0 or not, so that the cross slope can be obtained even in the curve. It is possible to switch to an appropriate integration according to. Further, the lane keeping device 1 can perform the switching with high accuracy in consideration of the vehicle position by performing the determination based on the offset threshold 2 smaller than the offset threshold 1. Therefore, it is possible to apply a steering torque so that the vehicle does not greatly deviate from the center of the lane during the curve, and the vehicle follows the center of the lane.

このように、レーンキープ装置1によれば、横断勾配に応じて適切な操舵トルクを付与することでき、車両を車線中心に沿って走行させる精度を向上させることができる。   Thus, according to the lane keeping device 1, it is possible to apply an appropriate steering torque according to the crossing gradient, and it is possible to improve the accuracy of traveling the vehicle along the lane center.

以上、本発明に係る実施の形態について説明したが、本発明は上記実施の形態に限定されることなく様々な形態で実施される。   As mentioned above, although embodiment which concerns on this invention was described, this invention is implemented in various forms, without being limited to the said embodiment.

例えば、本実施の形態ではレーンキープ装置に適用したが、他の装置にも適用可能であり、例えば、自動操舵装置に適用できる。   For example, although the present embodiment is applied to the lane keeping device, it can also be applied to other devices, for example, an automatic steering device.

また、本実施の形態では電動パワーステアリング装置を利用して操舵トルクを付加する構成としたが、レーンキープ装置にラックやピニオンをアシストするアクチュエータを備える構成としてもよい。したがって、パワーステアリング装置を備えない車両にも適用可能である。また、電動パワーステアリング装置ではなく、油圧式のパワーステアリング装置にも適用可能であり、油圧を調整するアクチュエータを制御することによって操舵トルクを付加する構成としてもよい。   In this embodiment, the steering torque is applied by using the electric power steering device. However, the lane keeping device may be provided with an actuator that assists the rack and pinion. Therefore, the present invention can be applied to a vehicle that does not include a power steering device. Further, the present invention can be applied not only to an electric power steering device but also to a hydraulic power steering device, and may be configured to add steering torque by controlling an actuator that adjusts hydraulic pressure.

また、本実施の形態では一対の白線を認識することにより車線を検出する構成としたが、白線以外の黄線などの他の線も認識することにより車線を検出する構成としてもよいしあるいは路肩や車線と歩道とを区画するブロックなどを認識することにより車線を検出するなど他の方法により車線を検出する構成としてもよい。また、本実施の形態では車線がある道路に適用したが、車線がない道路に対しても適用可能である。この場合には、その道路の路肩などを検出する必要がある。   In the present embodiment, the lane is detected by recognizing a pair of white lines. However, the lane may be detected by recognizing other lines such as a yellow line other than the white line, or a road shoulder. Alternatively, the lane may be detected by another method such as detecting the lane by recognizing a block that partitions the lane and the sidewalk. Further, although the present embodiment is applied to a road having a lane, the present invention can also be applied to a road having no lane. In this case, it is necessary to detect the shoulder of the road.

また、本実施の形態では直線かあるいはカーブかの判定をカーブ半径によって判定する構成としたが、道路形状の判定については他の手段を用いてもよい、例えば、カーナビゲーションシステムから走行中の道路の道路形状の情報を取得し、その情報から判定するようにしてもよい。   Further, in the present embodiment, the determination of whether it is a straight line or a curve is made based on the curve radius, but other means may be used for determining the road shape, for example, a road that is running from a car navigation system It is also possible to acquire information on the road shape and determine from the information.

また、本実施の形態ではカーブ半径によって直線かあるいはカーブかを判定し、2段階のオフセット閾値を設定する構成としたが、カーブの半径(曲率)に応じて複数の段階でオフセット閾値を設定し、カーブ半径が小さくなるほど大きいオフセット閾値を段階的に設定するようにしてもよい。このように設定することによって、カーブ半径に応じたより精度の高い制御ができる。   In this embodiment, the curve radius is determined to be a straight line or a curve, and a two-stage offset threshold is set. However, the offset threshold is set in a plurality of stages according to the radius (curvature) of the curve. Alternatively, a larger offset threshold may be set stepwise as the curve radius decreases. By setting in this way, more accurate control according to the curve radius can be performed.

また、本実施の形態ではカーブではオフセット閾値1としてオフセットDより大きいオフセットDを設定し、カーブでは右積分と左積分との切り替えが行われ難くする構成としたが、カーブではオフセット閾値1として無限大を設定し、カーブでは右積分と左積分との切り替えが行われない構成としてもよい。 Further, in the present embodiment, the offset D 1 larger than the offset D 0 is set as the offset threshold 1 in the curve so that the switching between the right integration and the left integration is difficult to be performed in the curve. However, in the curve, the offset threshold 1 is set. Infinite may be set as, and the curve may not be switched between right integration and left integration.

また、本実施の形態では2つのオフセットD、Dを用い、直線ではオフセットDによって右積分と左積分とを切り替え、カーブではオフセットDによって右積分と左積分とを切り替える構成とし、直線とカーブとでオフセット閾値の値を切り替えることによって、カーブでは直線に比べて右積分と左積分を切り替え難くしているので、カーブ走行中における車両の走行位置の変動を小さく抑えることができる。カーブでは直線に比べて右積分と左積分を切り替え難くする他の手法として、オフセット閾値の値を替えるのではなく、1つのオフセット閾値のみを用いて切り替え条件を変える構成としてもよい。例えば、車両のオフセットがオフセット閾値1の絶対値を超える時間を計測し、直線では計測時間と時間閾値1との比較によって右積分と左積分とを切り替え、カーブでは計測時間と時間閾値2(>時間閾値1)との比較によって右積分と左積分とを切り替える構成としてもよいし、あるいは、車両のオフセットがオフセット閾値1の絶対値を超える回数をカウントし、直線路ではカウント数と回数閾値1との比較によって右積分と左積分とを切り替え、カーブではカウント数と回数閾値2(>回数閾値1)との比較によって右積分と左積分とを切り替える構成としてもよい。このように、1つのオフセット閾値を用いて、オフセット閾値の絶対値を超える時間や回数などの閾値をカーブと直線とで切り替えることによって、カーブでは直線に比べて右積分と左積分を切り替え難くしているので、カーブ走行中における車両の走行位置の変動を小さく抑えることができる。 In the present embodiment, two offsets D 0 and D 1 are used, and in the straight line, the right integration and the left integration are switched by the offset D 0 in the straight line, and in the curve, the right integration and the left integration are switched by the offset D 1 . By switching the offset threshold value between the straight line and the curve, it is difficult to switch the right integration and the left integration in the curve compared to the straight line, so that the variation in the travel position of the vehicle during the curve travel can be suppressed small. As another method for making it difficult to switch between right integration and left integration in a curve as compared with a straight line, the switching condition may be changed using only one offset threshold value instead of changing the offset threshold value. For example, the time when the vehicle offset exceeds the absolute value of the offset threshold 1 is measured, the right integration and the left integration are switched by comparing the measurement time with the time threshold 1 in the straight line, and the measurement time and the time threshold 2 (> in the curve) The right integration and the left integration may be switched by comparison with the time threshold 1), or the number of times that the vehicle offset exceeds the absolute value of the offset threshold 1 is counted. The right integration and the left integration may be switched by comparing with the left and the right integration and the left integration may be switched by comparing the number of counts with the number threshold 2 (> threshold 1). In this way, by using one offset threshold value and switching the threshold value such as the time and number of times exceeding the absolute value of the offset threshold value between the curve and the straight line, it is more difficult for the curve to switch between the right integration and the left integration than the straight line. Therefore, it is possible to suppress the fluctuation of the traveling position of the vehicle during the curve traveling.

また、本実施の形態ではカーブか否かでオフセット閾値1の値を切り替える制御と誤選択対策として一方側の積分値が0になった場合には他方側の積分に切り替える制御の両方を備える構成としたが、いずれか一方だけの制御を備える構成としてもよい。   Further, in the present embodiment, there is provided both a control for switching the value of the offset threshold 1 depending on whether or not it is a curve and a control for switching to the other-side integration when the one-side integration value becomes 0 as a countermeasure against erroneous selection. However, it may be configured to have only one of the controls.

また、本実施の形態では誤選択対策として積分値が0になった場合にオフセット閾値2による判定を行う構成としたが、オフセット閾値2の判定を無くし、積分値が0になった場合には積分を切り替える構成としてもよい。   Further, in the present embodiment, as a countermeasure for erroneous selection, the determination is made based on the offset threshold 2 when the integrated value becomes 0. However, when the determination of the offset threshold 2 is eliminated and the integrated value becomes 0, It is good also as a structure which switches integration.

本実施の形態に係るレーンキープ装置の構成図である。It is a block diagram of the lane keeping apparatus which concerns on this Embodiment. 本実施の形態に係るレーンキープ装置の制御ブロック図である。It is a control block diagram of the lane keeping device according to the present embodiment. オフセット閾値1の値の切替処理の説明図であり、(a)が直線であり、(b)がカーブである。It is explanatory drawing of the switching process of the value of the offset threshold value 1, (a) is a straight line, (b) is a curve. 誤選択の積分の修正処理の説明図である。It is explanatory drawing of the correction process of the mistaken integration. 図1のレーンキープECUにおける積分切替処理の流れを示すフローチャートである。It is a flowchart which shows the flow of the integral switching process in lane keep ECU of FIG.

符号の説明Explanation of symbols

1…レーンキープ装置、2…白線認識センサ、2a…カメラ、2b…白線認識ECU、3…レーンキープECU、10…電動パワーステアリング装置、10a…EPSECU、10b…EPSモータ   DESCRIPTION OF SYMBOLS 1 ... Lane keeping device, 2 ... White line recognition sensor, 2a ... Camera, 2b ... White line recognition ECU, 3 ... Lane keep ECU, 10 ... Electric power steering device, 10a ... EPSECU, 10b ... EPS motor

Claims (4)

撮像手段により走行路を撮像し、車両が走行路の所定位置に沿って走行するように操舵機構に操舵トルクを付与する操舵装置において、
走行路の所定位置に対する車両位置の偏差を積分し、走行路の所定位置に対する右側分の積分値を求める第1積分手段と、
走行路の所定位置に対する車両位置の偏差を積分し、走行路の所定位置に対する左側分の積分値を求める第2積分手段と、
走行路の所定位置に対する車両位置の偏差と走行路の所定位置からの所定距離に基づいて前記第1積分手段と前記第2積分手段とを切り替える切替手段と、
前記切替手段で切り替えた積分手段の積分値に基づいて操舵機構に付与する操舵トルクを設定する操舵トルク設定手段と
を備え、
走行路の曲率が大きいときは走行路の曲率が小さいときより前記第1積分手段と前記第2積分手段との切り替えが行われ難くすることを特徴とする操舵装置。
In a steering apparatus that images a travel path by an imaging unit and applies a steering torque to a steering mechanism so that the vehicle travels along a predetermined position of the travel path.
A first integrating means for integrating a deviation of the vehicle position with respect to a predetermined position on the travel path and obtaining an integral value of the right side with respect to the predetermined position on the travel path;
A second integrating means for integrating the deviation of the vehicle position with respect to the predetermined position of the travel path and obtaining an integral value of the left side with respect to the predetermined position of the travel path;
Switching means for switching between the first integrating means and the second integrating means based on a deviation of the vehicle position with respect to a predetermined position on the traveling path and a predetermined distance from the predetermined position on the traveling path;
Steering torque setting means for setting a steering torque to be applied to the steering mechanism based on the integration value of the integration means switched by the switching means;
A steering apparatus characterized in that the switching between the first integrating means and the second integrating means is less likely to be performed when the curvature of the traveling road is large than when the curvature of the traveling road is small.
前記走行路の所定位置からの所定距離を走行路の曲率に基づいて決定することを特徴とする請求項1に記載する操舵装置。   The steering apparatus according to claim 1, wherein a predetermined distance from a predetermined position on the travel path is determined based on a curvature of the travel path. 前記走行路の所定位置からの所定距離を走行路の曲率が大きくなるほど大きくすることを特徴とする請求項1又は請求項2に記載する操舵装置。   The steering apparatus according to claim 1 or 2, wherein a predetermined distance from a predetermined position on the travel path is increased as the curvature of the travel path increases. 撮像手段により走行路を撮像し、車両が走行路の所定位置に沿って走行するように操舵機構に操舵トルクを付与する操舵装置において、
走行路の所定位置に対する車両位置の偏差を積分し、走行路の所定位置に対する右側分の積分値を求める第1積分手段と、
走行路の所定位置に対する車両位置の偏差を積分し、走行路の所定位置に対する左側分の積分値を求める第2積分手段と、
走行路の所定位置に対する車両位置の偏差と走行路の所定位置からの所定距離に基づいて前記第1積分手段と前記第2積分手段とを切り替える切替手段と、
前記切替手段で切り替えた積分手段の積分値に基づいて操舵機構に付与する操舵トルクを設定する操舵トルク設定手段と
を備え、
前記切替手段は、前記第1積分手段または前記第2積分手段のいずれか一方の積分手段に切り替えられている状態で、当該切り替えられている一方の積分手段の他方側における走行路の所定位置に対する車両位置の偏差が走行路の所定位置からの所定距離の絶対値以下の場合、当該切り替えられている一方の積分手段の積分値が0あるいは0近傍のときに他方の積分手段に切り替えることを特徴とする操舵装置。
In a steering apparatus that images a travel path by an imaging unit and applies a steering torque to a steering mechanism so that the vehicle travels along a predetermined position of the travel path.
A first integrating means for integrating a deviation of the vehicle position with respect to a predetermined position on the travel path and obtaining an integral value of the right side with respect to the predetermined position on the travel path;
A second integrating means for integrating the deviation of the vehicle position with respect to the predetermined position of the travel path and obtaining an integral value of the left side with respect to the predetermined position of the travel path;
Switching means for switching between the first integrating means and the second integrating means based on a deviation of the vehicle position with respect to a predetermined position on the traveling path and a predetermined distance from the predetermined position on the traveling path;
Steering torque setting means for setting a steering torque to be applied to the steering mechanism based on the integration value of the integration means switched by the switching means;
In the state where the switching means is switched to one of the first integrating means or the second integrating means, the switching means is for a predetermined position on the travel path on the other side of the switched one integrating means. When the deviation of the vehicle position is equal to or smaller than the absolute value of the predetermined distance from the predetermined position on the travel path, the switching is switched to the other integrating means when the integrated value of one of the switched integrating means is 0 or near zero. Steering device.
JP2005198948A 2005-07-07 2005-07-07 Steering device Expired - Fee Related JP4434095B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005198948A JP4434095B2 (en) 2005-07-07 2005-07-07 Steering device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005198948A JP4434095B2 (en) 2005-07-07 2005-07-07 Steering device

Publications (2)

Publication Number Publication Date
JP2007015545A JP2007015545A (en) 2007-01-25
JP4434095B2 true JP4434095B2 (en) 2010-03-17

Family

ID=37753071

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005198948A Expired - Fee Related JP4434095B2 (en) 2005-07-07 2005-07-07 Steering device

Country Status (1)

Country Link
JP (1) JP4434095B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10099691B2 (en) * 2014-05-30 2018-10-16 Denso Corporation Apparatus and program for assisting drive of vehicle
CN108820039A (en) * 2018-05-11 2018-11-16 江苏大学 A kind of automatic driving vehicle bend crosswise joint system and method

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4892958B2 (en) * 2005-12-21 2012-03-07 トヨタ自動車株式会社 Steering device
JP5213576B2 (en) * 2008-08-01 2013-06-19 富士重工業株式会社 Lane departure prevention control device
CN104602989B (en) * 2012-09-04 2016-03-16 日产自动车株式会社 Control device for stability
JP6848677B2 (en) * 2017-05-19 2021-03-24 日産自動車株式会社 Vehicle control method and vehicle control device

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10099691B2 (en) * 2014-05-30 2018-10-16 Denso Corporation Apparatus and program for assisting drive of vehicle
US10843695B2 (en) 2014-05-30 2020-11-24 Denso Corporation Apparatus and program for assisting drive of vehicle
CN108820039A (en) * 2018-05-11 2018-11-16 江苏大学 A kind of automatic driving vehicle bend crosswise joint system and method

Also Published As

Publication number Publication date
JP2007015545A (en) 2007-01-25

Similar Documents

Publication Publication Date Title
JP5124874B2 (en) Vehicle travel support device, vehicle, vehicle travel support program
JP5109296B2 (en) Driving support device
US7571053B2 (en) Lane deviation prevention apparatus
US20220363250A1 (en) Vehicular driving assistance system with lateral motion control
JP6776998B2 (en) Autonomous driving system
EP2052949B1 (en) Steering support device
JP2005524135A (en) Side guide support method and apparatus for vehicle
CN109562784B (en) Assist force control device and assist force control method
JP4434095B2 (en) Steering device
JP4432941B2 (en) Steering support device
JP4923567B2 (en) Steering device
JP2001206237A (en) Device for preventing vehicle from deviating from lane
JP4107078B2 (en) Vehicle steering control device
JP4892958B2 (en) Steering device
JP5294055B2 (en) Travel control device
JP4517958B2 (en) Traveling path detection device
JP4951947B2 (en) Steering device
US20220388508A1 (en) Lane keeping controller, vehicle system including the same, and method thereof
JP5298802B2 (en) Steering support device
JP4923565B2 (en) Steering device
JP4923564B2 (en) Steering device
JP2018079892A (en) Vehicle control device
JP5124876B2 (en) Vehicle travel support device, vehicle, vehicle travel support program
JP4715372B2 (en) Steering support device
JP4240000B2 (en) Vehicle steering control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080602

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20091120

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: 20091208

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: 20091221

R151 Written notification of patent or utility model registration

Ref document number: 4434095

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130108

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130108

Year of fee payment: 3

LAPS Cancellation because of no payment of annual fees