JP2007145227A - Steering device - Google Patents
Steering device Download PDFInfo
- Publication number
- JP2007145227A JP2007145227A JP2005344114A JP2005344114A JP2007145227A JP 2007145227 A JP2007145227 A JP 2007145227A JP 2005344114 A JP2005344114 A JP 2005344114A JP 2005344114 A JP2005344114 A JP 2005344114A JP 2007145227 A JP2007145227 A JP 2007145227A
- Authority
- JP
- Japan
- Prior art keywords
- curve
- steering
- vehicle
- exit
- road
- 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
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Power Steering Mechanism (AREA)
Abstract
Description
本発明は、走行路の所定位置に沿って走行するように操舵機構を制御する操舵装置に関する。 The present invention relates to a steering apparatus that controls a steering mechanism so as to travel along a predetermined position on a traveling path.
操舵装置には、車両前方の走行路の撮像画像から車線を認識し、車両が車線中央に沿って走行するようにトルクを操舵機構に付加するレーンキープ装置がある(特許文献1参照)。レーンキープ装置では、認識した車線と車両から走行路のカーブ半径(道路曲率)、車線に対する車両のヨー角、車線中心からの車両のオフセットなどを求める。そして、レーンキープ装置では、道路曲率に基づいてフィードフォワード出力を求めるとともにヨー角とオフセットに基づいてフィードバック出力をそれぞれ求め、これらの出力から操舵機構に付加する出力トルクを設定する。さらに、レーンキープ装置には、オフセットを積分し、その積分項に基づくフィードバック出力も出力トルクに加味しているものがある。 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 torque to the steering mechanism so that the vehicle travels along the center of the lane (see Patent Document 1). In the lane keeping device, the curve radius (road curvature) of the travel path from the recognized lane and the vehicle, the yaw angle of the vehicle with respect to the lane, the offset of the vehicle from the lane center, and the like are obtained. In the lane keeping device, the feedforward output is obtained based on the road curvature, the feedback output is obtained based on the yaw angle and the offset, and the output torque to be added to the steering mechanism is set from these outputs. Further, some lane keeping devices integrate an offset, and a feedback output based on the integral term also takes into account the output torque.
道路には、排水やカーブの方向などを考慮し、道路の左右どちらかの方向に傾斜した路面カント(横断勾配)が設けられている。カーブ路の場合、通常、カーブ内側が低くなる路面カントが設けられている。そのため、カーブ路では、車両には路面カントによってカーブ内側方向に向かう力(横加速度)が作用する。この路面カントの傾斜が大きいほど、車両に作用する横加速度が大きくなり、車両が車線中心からカーブ内側に寄る場合がある。この場合、レーンキープ装置では、カーブ内側のオフセットの積分項が大きくなり、この積分項に基づいてカーブ外側方向のトルクを出力トルクに加味する。また、フィードフォワード出力は上限が設定されているので、カーブ路では、高車速やカーブ半径が小さいほど、フィードフォワード出力が不足し、車両が車線中心からカーブ外側に寄る場合がある。この場合、レーンキープ装置では、カーブ外側のオフセットの積分項が大きくなり、この積分項に基づいてカーブ内側方向のトルクを出力トルクに加味する。カーブ路の場合、レーンキープ装置では、このようなオフセットの積分項を利用して路面カントの影響やフィードフォワード不足を補償し、車両が車線中央に沿って走行できるようにしている。
カーブ路から直線路や曲がる方向が異なるカーブ路に進入すると、路面カントの傾斜方向が変わり、カーブ路走行中に求められたオフセットの積分項に基づくトルクが不要となる。そのため、直線路あるいは曲がる方向が異なるカーブ路に進入すると、カーブ外側の積分項の場合(積分項に基づくトルクを付加する方向がカーブ内側方向の場合)にはカーブ巻き込み(ステアリングホイールの切り戻し遅れ)を招く可能性があり、カーブ内側の積分項の場合(積分項に基づくトルクを付加する方向がカーブ外側方向の場合)には車線逸脱を招く可能性がある。 When a straight road or a curved road with a different turning direction is entered from the curved road, the inclination direction of the road surface cant changes, and torque based on the integral term of the offset obtained during traveling on the curved road becomes unnecessary. Therefore, when entering a straight road or a curved road with a different turning direction, in the case of an integral term outside the curve (when the direction of applying torque based on the integral term is the curve inside direction), the curve is involved (the steering wheel switchback delay) In the case of an integral term inside the curve (when the direction of applying torque based on the integral term is the direction outside the curve), there is a possibility of causing a lane departure.
そこで、本発明は、カーブ出口において適切な操舵制御を行うことができる操舵装置を提供することを課題とする。 Therefore, an object of the present invention is to provide a steering device that can perform appropriate steering control at a curve exit.
本発明に係る操舵装置は、車両の走行路を検出する走行路検出手段と、車両の走行路の所定位置からのずれ量を検出するずれ量検出手段と、当該ずれ量を積分して積分項を求める積分手段と、車両の走行路の所定位置からのずれ量及び積分項に基づいて操舵機構を制御するための操舵出力を演算する演算手段とを備え、車両が走行路の所定位置に沿って走行するように操舵機構を制御する操舵装置において、道路のカーブ半径を検出するカーブ半径検出手段と、車両位置がカーブ路の出口か否かを判断するカーブ出口判断手段と、車両の進行方向を検出する車両進行方向検出手段とを備え、カーブ半径検出手段で検出したカーブ半径が所定半径以上のカーブ路を走行中にカーブ出口判断手段で車両位置がカーブ路の出口と判断した場合、車両進行方向検出手段で検出した車両進行方向と積分項に基づく操舵制御方向とが一致するときに積分項をリセットすることを特徴とする。 A steering apparatus according to the present invention includes a travel path detection unit that detects a travel path of a vehicle, a shift amount detection unit that detects a shift amount from a predetermined position of the travel path of the vehicle, and an integral term that integrates the shift amount. Integrating means for calculating the steering angle, and calculating means for calculating a steering output for controlling the steering mechanism on the basis of an amount of deviation from the predetermined position of the travel path of the vehicle and an integral term, and the vehicle follows the predetermined position on the travel path. In the steering device that controls the steering mechanism so as to travel, a curve radius detection unit that detects a curve radius of a road, a curve exit determination unit that determines whether or not the vehicle position is an exit of a curved road, and a traveling direction of the vehicle Vehicle traveling direction detection means for detecting the vehicle, and when the vehicle exit is determined to be the exit of the curve road by the curve exit determination means while traveling on a curved road having a curve radius detected by the curve radius detection means greater than or equal to a predetermined radius, Characterized by resetting the integral term when the steering control direction based on the vehicle traveling direction and the integral term which is detected in the row direction detection means coincide.
この操舵装置では、走行路検出手段により走行路を検出する。そして、操舵装置では、ずれ量検出手段により走行路の所定位置に対する車両位置のずれ量を検出し、積分手段によりそのずれ量を積分して積分項を求める。さらに、操舵装置では、そのずれ量を減少させるように(積分項を増加させないように)、演算手段によりずれ量及び積分項に基づいて操舵機構を制御するための操舵出力を演算し、その操舵出力により車両が走行路の所定位置に沿って走行するように操舵機構を制御する。走行路の左右方向の一方向側にずれ量(ひいては、積分項)が存在する場合、車両が走行路の所定位置に対して一方向側にずれているので、車両が他方向側に向かうように操舵機構が制御される。したがって、ずれ量や積分項が左右方向のいずれの側に存在するかによって、操舵制御方向が判断される。また、操舵装置では、カーブ半径検出手段により走行路のカーブ半径を検出し、カーブ出口判断手段により車両がカーブ路の出口か否かを判断し、車両進行方向検出手段により車両の進行方向を検出する。そして、操舵装置では、カーブ半径が所定半径以上のカーブ路(比較的緩やかなカーブ)を走行中に車両位置がカーブ出口にきたと判断した場合、車両の進行方向が積分項に基づく操舵制御方向に一致するときには積分項をリセットし、それ以外のときには積分項をリセットしない。大きなカーブ半径ほど、路面カント(カーブ半径が大きいほど路面カントの傾斜が少ない)の影響やフィードフォワード出力不足が小さくなるので、積分項が小さく、基本的には、カーブ出口において積分項をリセットする必要がない。そこで、この場合、操舵装置では、操舵機構を制御するための操舵出力に積分項に基づくフィードバック出力を加味する。しかし、車両の進行方向と積分項に基づく操舵制御方向とが同方向のときには、その積分項に基づくフィードバック出力によって車両の進行方向側に車両が更に操舵制御され、カーブ出口において車両が走行路の所定位置からずれてゆく。そこで、この場合、操舵装置では、積分項をリセットし、操舵機構を制御するための操舵出力に積分項に基づくフィードバック出力を加味しない。その結果、車線逸脱やカーブ巻き込みが発生しない。このように、この操舵装置では、大きなカーブ半径のカーブ路の出口において、不要な積分項に基づくフィードバック出力を排除し、適切な操舵制御を行うことができる。 In this steering device, the travel path is detected by the travel path detection means. In the steering device, a deviation amount of the vehicle position with respect to a predetermined position on the travel path is detected by the deviation amount detection means, and the integral term is obtained by integrating the deviation amount by the integration means. Further, in the steering device, the steering output for controlling the steering mechanism is calculated based on the deviation amount and the integral term by the calculation means so as to reduce the deviation amount (so as not to increase the integral term). The steering mechanism is controlled so that the vehicle travels along a predetermined position on the travel path by the output. When there is a deviation amount (and hence an integral term) on the one side in the left-right direction of the travel path, the vehicle is shifted toward one direction with respect to a predetermined position on the travel path. The steering mechanism is controlled. Therefore, the steering control direction is determined depending on which side in the left-right direction the deviation amount or the integral term exists. In the steering apparatus, the curve radius detection means detects the curve radius of the travel road, the curve exit determination means determines whether the vehicle is an exit of the curve road, and the vehicle travel direction detection means detects the vehicle travel direction. To do. When the steering device determines that the vehicle position has reached the curve exit while traveling on a curved road with a curve radius equal to or greater than a predetermined radius (a relatively gentle curve), the steering control direction based on the integral term is the vehicle traveling direction. The integral term is reset when the values coincide with each other, and the integral term is not reset otherwise. The larger the curve radius, the smaller the integral term because the influence of the road surface cant (the larger the curve radius, the less the slope of the road surface cant) and the feedforward output shortage are small. Basically, the integral term is reset at the curve exit. There is no need. Therefore, in this case, the steering apparatus adds a feedback output based on the integral term to the steering output for controlling the steering mechanism. However, when the traveling direction of the vehicle and the steering control direction based on the integral term are the same direction, the vehicle is further steered to the traveling direction side of the vehicle by the feedback output based on the integral term, and the vehicle is Deviation from the predetermined position. Therefore, in this case, the steering device resets the integral term, and does not add the feedback output based on the integral term to the steering output for controlling the steering mechanism. As a result, no lane departure or curve entrainment occurs. As described above, in this steering apparatus, it is possible to perform appropriate steering control by eliminating feedback output based on an unnecessary integral term at the exit of a curved road having a large curve radius.
本発明の上記操舵装置では、車両進行方向検出手段は、車両の走行路に対する角度に基づいて進行方向を検出する構成としてもよい。 In the above steering apparatus of the present invention, the vehicle traveling direction detection means may be configured to detect the traveling direction based on the angle of the vehicle with respect to the traveling path.
この操舵装置では、車両進行方向検出手段により走行路に対する車両の角度に基づいて進行方向を検出する。操舵装置では、走行路を検出しているので、この走行路を利用することにより簡単かつ高精度に車両の進行方向を求めることができる。 In this steering apparatus, the traveling direction is detected based on the angle of the vehicle with respect to the travel path by the vehicle traveling direction detection means. Since the steering device detects the traveling road, the traveling direction of the vehicle can be obtained easily and with high accuracy by using the traveling road.
本発明の上記操舵装置では、カーブ出口判断手段は、カーブ半径に基づいて判断する構成としてもよい。 In the above steering apparatus of the present invention, the curve exit determining means may be configured to determine based on the curve radius.
この操舵装置では、カーブ出口判断手段によりカーブ半径(道路曲率)に基づいてカーブ出口か否かを判断する。カーブ路の場合、カーブに進入するとカーブ半径が小さくなり(道路曲率が大きくなり)、最小のカーブ半径になった後に、カーブ出口に近づくほどカーブ半径が大きくなる(道路曲率が小さくなる)。したがって、カーブ半径(道路曲率)の変化によって、簡単かつ高精度にカーブ路の出口を推測することができる。 In this steering apparatus, it is determined by the curve exit determination means whether the vehicle is a curve exit based on the curve radius (road curvature). In the case of a curved road, the curve radius decreases when the vehicle enters the curve (the road curvature increases), and after reaching the minimum curve radius, the curve radius increases (the road curvature decreases) as it approaches the curve exit. Therefore, the exit of the curved road can be estimated easily and with high accuracy by changing the curve radius (road curvature).
本発明に係る操舵装置では、車両の走行路を検出する走行路検出手段と、車両の走行路の所定位置からのずれ量を検出するずれ量検出手段と、当該ずれ量を積分して積分項を求める積分手段と、車両の走行路の所定位置からのずれ量及び積分項に基づいて操舵機構を制御するための操舵出力を演算する演算手段とを備え、車両が走行路の所定位置に沿って走行するように操舵機構を制御する操舵装置において、道路のカーブ半径を検出するカーブ半径検出手段と、車両位置がカーブ路の出口か否かを判断するカーブ出口判断手段とを備え、カーブ半径検出手段で検出したカーブ半径が所定半径以下のカーブ路を走行中にカーブ出口判断手段で車両位置がカーブ路の出口と判断した場合に積分項をリセットすることを特徴とする。 In the steering apparatus according to the present invention, a travel path detection unit that detects a travel path of the vehicle, a shift amount detection unit that detects a shift amount from a predetermined position of the travel path of the vehicle, and an integral term that integrates the shift amount. Integrating means for calculating the steering angle, and calculating means for calculating a steering output for controlling the steering mechanism on the basis of an amount of deviation from the predetermined position of the travel path of the vehicle and an integral term, and the vehicle follows the predetermined position on the travel path. In the steering apparatus that controls the steering mechanism so as to travel, the vehicle includes a curve radius detection unit that detects a curve radius of the road and a curve exit determination unit that determines whether or not the vehicle position is an exit of a curve road, The integral term is reset when the curve exit determining means determines that the vehicle position is the exit of the curved road while traveling on a curved road having a curve radius detected by the detecting means not more than a predetermined radius.
この操舵装置では、上記の操舵装置と同様に、ずれ量及び積分項に基づいて車両が走行路の所定位置に沿って走行するように操舵機構を制御する。また、操舵装置では、カーブ半径検出手段により走行路のカーブ半径を検出し、カーブ出口判断手段により車両位置がカーブ路の出口か否かを判断する。そして、操舵装置では、カーブ半径が所定半径以下のカーブ路(比較的急なカーブ)を走行中に車両位置がカーブ出口にきたと判断した場合に積分項をリセットする。小さいカーブ半径ほど、路面カント(カーブ半径が小さいほど路面カントの傾斜が大きい)の影響やフィードフォワード出力不足が大きくなるので、積分項が大きく、その積分項に基づくフィードバック出力によって、カーブ出口において車両が走行路の所定位置からずれてゆく。そこで、この場合、操舵装置では、積分項をリセットし、操舵機構を制御するための操舵出力に積分項に基づくフィードバック出力を加味しない。その結果、車線逸脱やカーブ巻き込みが発生しない。このように、この操舵装置では、小さなカーブ半径のカーブ路の出口において、不要な積分項によるフィードバック出力を排除し、適切な操舵制御を行うことができる。 In this steering device, similarly to the steering device described above, the steering mechanism is controlled so that the vehicle travels along a predetermined position on the travel path based on the deviation amount and the integral term. In the steering device, the curve radius detecting means detects the curve radius of the traveling road, and the curve exit determining means determines whether or not the vehicle position is the exit of the curved road. Then, the steering device resets the integral term when it is determined that the vehicle position has come to the curve exit while traveling on a curve road (a relatively steep curve) having a curve radius equal to or less than a predetermined radius. The smaller the curve radius, the greater the influence of the road surface cant (the smaller the curve radius, the greater the slope of the road surface cant) and the lack of feedforward output. Deviates from a predetermined position on the road. Therefore, in this case, the steering device resets the integral term, and does not add the feedback output based on the integral term to the steering output for controlling the steering mechanism. As a result, no lane departure or curve entrainment occurs. As described above, in this steering apparatus, it is possible to perform appropriate steering control by eliminating feedback output due to an unnecessary integral term at the exit of a curved road having a small curve radius.
本発明に係る操舵装置では、車両の走行路を検出する走行路検出手段と、車両の走行路の所定位置からのずれ量を検出するずれ量検出手段と、当該ずれ量を積分して積分項を求める積分手段と、車両の走行路の所定位置からのずれ量及び積分項に基づいて操舵機構を制御するための操舵出力を演算する演算手段とを備え、車両が走行路の所定位置に沿って走行するように操舵機構を制御する操舵装置において、道路のカーブ半径を検出するカーブ半径検出手段と、カーブ路の曲がる方向を検出するカーブ方向検出手段とを備え、カーブ半径検出手段で検出したカーブ半径が所定半径以下のカーブ路を走行中にカーブ方向検出手段で検出したカーブ路の曲がる方向と積分項に基づく操舵制御方向とが一致した場合に積分項をリセットするタイミングをカーブ路の出口に基づくタイミングより早めることを特徴とする。 In the steering apparatus according to the present invention, a travel path detection unit that detects a travel path of the vehicle, a shift amount detection unit that detects a shift amount from a predetermined position of the travel path of the vehicle, and an integral term that integrates the shift amount. Integrating means for calculating the steering angle, and calculating means for calculating a steering output for controlling the steering mechanism on the basis of an amount of deviation from the predetermined position of the travel path of the vehicle and an integral term, and the vehicle follows the predetermined position on the travel path. In the steering device that controls the steering mechanism so that the vehicle travels, the vehicle includes a curve radius detection unit that detects a curve radius of the road and a curve direction detection unit that detects a direction in which the curve road is bent. The timing for resetting the integral term when the turning direction of the curved road detected by the curve direction detection means coincides with the steering control direction based on the integral term while traveling on a curved road having a curve radius equal to or less than the predetermined radius. Wherein the advancing the timing based on the exit of the curved road and grayed.
この操舵装置では、上記の操舵装置と同様に、ずれ量及び積分項に基づいて車両が走行路の所定位置に沿って走行するように操舵機構を制御する。また、操舵装置では、カーブ半径検出手段により道路のカーブ半径を検出し、カーブ方向検出手段によりカーブ路の曲がる方向を検出する。そして、操舵装置では、カーブ半径が所定半径以下のカーブ路を走行中にカーブ路の曲がる方向と積分項に基づく操舵制御方向とが一致した場合に積分項をリセットするタイミングをカーブ出口のリセットタイミングより早める(つまり、カーブ出口よりカーブの入口側で積分項をリセットする)。小さいカーブ半径ほど、フィードフォワード出力不足が大きくなり、カーブ路の曲がる方向と異なる側の積分項が大きくなる。この場合、カーブ路の曲がる方向と積分項に基づく操舵制御方向とが同方向となり、カーブ出口付近で巻き込みが発生する可能性がある。そこで、この場合、操舵装置では、カーブ出口よりカーブ入口側で積分項をリセットし、カーブ出口にくる前に、操舵機構を制御するための操舵出力に積分項に基づくフィードバック出力を加味しない。その結果、カーブ巻き込みが発生しない。このように、この操舵装置では、小さなカーブ半径のカーブ路の出口付近において、不要な積分項によるフィードバック出力を排除し、適切な操舵制御を行うことができる。 In this steering device, similarly to the steering device described above, the steering mechanism is controlled so that the vehicle travels along a predetermined position on the travel path based on the deviation amount and the integral term. In the steering device, the curve radius detecting means detects the road curve radius, and the curve direction detecting means detects the direction of the curve road to bend. Then, in the steering device, the timing at which the integral term is reset when the turning direction of the curved road coincides with the steering control direction based on the integral term while traveling on a curved road having a radius less than or equal to the predetermined radius is the reset timing at the curve exit. Faster (that is, reset the integral term on the curve entrance side than the curve exit). The smaller the curve radius, the larger the feedforward output shortage, and the larger the integral term on the side different from the curve direction of the curve path. In this case, the turning direction of the curved road and the steering control direction based on the integral term become the same direction, and there is a possibility that entrainment occurs near the curve exit. Therefore, in this case, the steering device resets the integral term on the curve entrance side from the curve exit, and does not add the feedback output based on the integral term to the steering output for controlling the steering mechanism before reaching the curve exit. As a result, no curve entrainment occurs. As described above, in this steering apparatus, it is possible to perform appropriate steering control by eliminating feedback output due to an unnecessary integral term in the vicinity of the exit of a curved road having a small curve radius.
本発明の上記操舵装置では、ドライバによる操舵方向を検出する操舵方向検出手段を備え、操舵方向検出手段で検出したドライバによる操舵方向とカーブ方向検出手段で検出したカーブ路の曲がる方向とが異なる場合に積分項をリセットするタイミングを早める構成としてもよい。 The steering device according to the present invention includes a steering direction detection unit that detects a steering direction by the driver, and the steering direction by the driver detected by the steering direction detection unit is different from the bending direction of the curve road detected by the curve direction detection unit. Alternatively, the timing for resetting the integral term may be advanced.
この操舵装置では、操舵方向検出手段によりドライバによる操舵方向を検出する。そして、操舵装置では、カーブ半径が所定半径以下のカーブ路を走行中にカーブ路の曲がる方向と積分項に基づく操舵制御方向とが一致しかつドライバの操舵方向がカーブ路の曲がる方向と異なる場合に積分項をリセットするタイミングを早める。小さいカーブ半径のカーブ路を出るときには、通常、ドライバは、カーブ出口に至る前にステアリングホイールを切り戻し、次に進入する直線あるいは逆方向のカーブ路に備えたステアリング操作を行う。したがって、ドライバの操舵方向によって、カーブ出口付近(カーブ入口側)を高精度に推測することが可能である。逆に、未だドライバがカーブ路の曲がる方向にステアリング操作を行っているときに積分項に基づくフィードバック出力を加味しないと、操舵フィーリングが低下する。そこで、この操舵装置では、ドライバの操舵方向も考慮して積分項をリセットするタイミングを高精度に判定している。 In this steering apparatus, the steering direction by the driver is detected by the steering direction detection means. And, in the steering device, when the curved road having a curved radius equal to or less than a predetermined radius is traveling, the direction of the curved road is coincident with the steering control direction based on the integral term, and the driver's steering direction is different from the curved direction of the curved road. Advance the timing to reset the integral term. When exiting a curve road having a small curve radius, the driver usually turns the steering wheel back before reaching the curve exit, and performs a steering operation in preparation for the next straight or reverse curve road. Therefore, the vicinity of the curve exit (the curve entrance side) can be estimated with high accuracy according to the steering direction of the driver. On the other hand, if the driver is still performing the steering operation in the direction of the curved road, if the feedback output based on the integral term is not taken into account, the steering feeling is lowered. Therefore, in this steering apparatus, the timing for resetting the integral term is determined with high accuracy in consideration of the steering direction of the driver.
本発明の上記操舵装置では、カーブ路の出口に接近したときに積分項をリセットすると好適である。 In the steering apparatus of the present invention, it is preferable to reset the integral term when approaching the exit of the curved road.
この操舵装置では、カーブ出口に至る前のカーブ路の出口に接近したときに、積分項をリセットし、操舵機構を制御するための操舵出力に積分項に基づくフィードバック出力を加味しない。このように、カーブ出口に接近したときに積分項の影響を排除し、カーブ巻き込みを確実に防止する。 In this steering device, the integral term is reset when approaching the exit of the curve road before reaching the curve exit, and the feedback output based on the integral term is not added to the steering output for controlling the steering mechanism. In this way, the influence of the integral term is eliminated when approaching the curve exit, and curb entrainment is reliably prevented.
なお、走行路としては、例えば、走行中の車線、車線のない場合には走行中の道路自体である。走行路の所定位置としては、例えば、走行路(車線)の中心である。操舵機構を制御する際の操舵出力としては、操舵トルク、操舵角など操舵状態を変化させることができるものならよい。走行路検出手段としては、例えば、撮像手段で撮像した撮像画像に基づいて検出する場合、ナビゲーションシステムによる処理と地図情報に基づいて検出する場合、各種センサを用いて検出する場合、路車間通信などを利用して車外から情報を取得する場合がある。操舵制御方向は、操舵装置における出力として操舵トルクや操舵角などを作用させる方向であり、右方向と左方向である。 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 steering output when controlling the steering mechanism may be any output that can change the steering state such as the steering torque and the steering angle. As the travel path detection means, for example, when detecting based on a captured image captured by the imaging means, when detecting based on processing by the navigation system and map information, when detecting using various sensors, road-to-vehicle communication, etc. Information may be obtained from outside the vehicle using. The steering control direction is a direction in which a steering torque, a steering angle, or the like acts as an output in the steering device, and is a right direction and a left direction.
本発明は、カーブ出口において、不要な積分項によるフィードバック出力を排除し、適切な操舵制御を行うことができる。 The present invention eliminates feedback output due to an unnecessary integral term at a curve exit and can perform appropriate steering control.
以下、図面を参照して、本発明に係る操舵装置の実施の形態を説明する。 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 adds auxiliary steering torque toward the center of the left and right white lines (lanes), which is a travel path, in order to assist steering by a driver. To do.
図1〜図3を参照して、本実施の形態に係るレーンキープ装置1について説明する。図1は、本実施の形態に係るレーンキープ装置の構成図である。図2は、図1のレーンキープ装置の制御ブロック図である。図3は、図1のレーンキープ装置における目標横加速度に対する出力トルクのマップである。 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 of FIG. FIG. 3 is a map of output torque with respect to the target lateral acceleration in the lane keeping device of FIG.
レーンキープ装置1は、車線の中央を走行するために必要な出力トルクを設定し、電動パワーステアリング装置を利用してその出力トルクを操舵機構に付加する。その際、レーンキープ装置1では、道路曲率γ(カーブ半径R)、車線に対する車両の向き(ヨー角θ)、車線中心に対する車両位置のずれ量(オフセットD)及びそのオフセットの積分項に基づいて目標横加速度を設定し、その目標加速度から出力トルクを求める。特に、レーンキープ装置1では、カーブ出口において適切な出力トルクを付加するために、カーブ出口又はカーブ出口付近(カーブ入口側)において不要な積分項をリセットする。レーンキープ装置1は、操舵トルクセンサ10、車速センサ11、CCD[Charge Coupled Device]カメラ20、画像処理部21、ECU[Electronic Control Unit]30を備えており、電動パワーステアリング装置40を利用する。
The lane keeping device 1 sets an output torque necessary for traveling in the center of the lane, and uses the electric power steering device to add the output torque to the steering mechanism. At that time, the lane keeping device 1 is based on the road curvature γ (curve radius R), the direction of the vehicle with respect to the lane (yaw angle θ), the displacement of the vehicle position with respect to the lane center (offset D), and the integral term of the offset. A target lateral acceleration is set, and an output torque is obtained from the target acceleration. In particular, the lane keeping device 1 resets an unnecessary integral term at the curve exit or in the vicinity of the curve exit (the curve entrance side) in order to add an appropriate output torque at the curve exit. The lane keeping device 1 includes a
車両における操舵機構では、ドライバによるステアリングホイール2に対する操作に応じて転舵輪(左右前輪FR,FL)を転舵させる。ステアリングホイール2は、ステアリングシャフト3の一端に固定されている。ステアリングシャフト3は、ステアリングホイール2の回転に伴って回転する。ステアリングシャフト3の他端には、ステアリングギヤボックス4を介してラックバー5が連結されている。ステアリングギヤボックス4は、ステアリングシャフト3の回転運動をラックバー5の軸方向への直進運動に変換する機能を有している。ラックバー5の両端は、ナックルアーム6を介して車輪FL,FRの各ハブキャリアに連結されている。このように構成されているため、車輪FL,FRは、ステアリングホイール2が回転されると、ステアリングシャフト3やステアリングギヤボックス4(ラックバー5)を介して転舵される。
In a steering mechanism in a vehicle, steered wheels (left and right front wheels FR, FL) are steered in accordance with an operation on the
電動パワーステアリング装置40は、EPS[Electric Power Steering]ECU41によってモータ42を駆動制御し、モータ42による駆動トルクによりドライバによる操舵をアシストする。EPSECU41では、ドライバの操舵による操舵トルクに基づいてアシストトルクを設定し、モータドライバによってそのアシストトルクを発生させるためにモータ42を駆動制御する。特に、EPSECU41では、ECU30からの出力トルク信号を受信すると、その出力トルク信号に示される出力トルクに所定の係数を乗算し、その乗算値(付加トルク)をアシストトルクに加算し、そのアシストトルク+付加トルクを発生させるためにモータ42を駆動制御する。モータ42による駆動トルクは操舵機構に付加され、操舵機構にはドライバによる操舵トルク以外にモータ42によるトルクが加わる。なお、操舵トルク、アシストトルク、出力トルク(付加トルク)は、プラス値/マイナス値で表され、その符号が方向を示す。各トルクは、プラス値が右方向へのトルク、マイナス値が左方向へのトルクを示す。
The electric
ラックバー5の一部外周面にはボールスクリュー溝が形成されており、モータ42のロータにはこのボールスクリュー溝に対応するボールスクリュー溝を内周面上に有するボールナットが固定されている。一対のボールスクリュー溝の間には複数のベアリングボールが収納されており、モータ42を駆動させるとロータが回転してラックバー5の軸方向の移動させることができる(すなわち、転舵をアシストすることができる)。この際、モータ42は、ECPECU41のモータドライバから供給された駆動電流に応じたトルクをラックバー5に付与する。
A ball screw groove is formed on a part of the outer peripheral surface of the
操舵トルクセンサ10は、ステアリングホイール2から入力された操舵トルクを検出するセンサである、操舵トルクセンサ10では、検出した操舵トルクを操舵トルク信号としてECU30に送信する。車速センサ11は、車両の速度を検出するセンサである。車速センサ11では、検出した車速を車速信号としてECU30に送信する。
The
CCDカメラ20は、レーンキープ装置1を搭載する車両の前方に取り付けられる(例えば、ルームミラーに内蔵)。この際、CCDカメラ20は、その光軸方向が車両の進行方向と一致するように取り付けられる。CCDカメラ20では、車両の前方の道路を撮像し、その撮像したカラー画像(例えば、RGB[Red Green Blue]による画像)を取得する。CCDカメラ20では、その撮像画像のデータを撮像信号として画像処理部21に送信する。CCDカメラ20は、左右方向に撮像範囲が広く、走行している車線を示す左右両側(一対)の白線を十分に撮像可能である。なお、CCDカメラ20はカラーであるが、道路上の白線を認識できる画像を取得できればよいので、白黒のカメラでもよい。
The
画像処理部21では、CCDカメラ20から撮像信号を取り入れ、撮像信号の撮像画像データから車両が走行している車線を示す一対の白線(道路区画線)を認識する。撮像画像では、路面とその上に描かれた白線との輝度差が大きいことから、走行レーンを区画する白線はエッジ検出などによって比較的検出しやすく、車両前方の車線を検出するのに都合がいい。
The
そして、画像処理部21では、認識した一対の白線から車線幅、一対の白線の中心を通る線(すなわち、車線の中心)を演算する。さらに、画像処理部21では、車線の中心の半径(カーブ半径R)を演算し、カーブ半径Rから道路曲率γ(=1/R)を演算する。また、画像処理部21では、車線の中心線と車両の前後方向の中心軸とのなす角度(ヨー角θ)及び車線の中心線に対する車両重心位置の横方向のずれ量(オフセットD)を演算する。そして、画像処理部21では、これら認識した一対の白線の情報や演算した各情報を画像信号としてECU30に送信する。
Then, the
なお、カーブ半径R、道路曲率γ、ヨー角θ、オフセットDは、プラス値/マイナス値で表され、その符号が方向を示す。カーブ半径R、道路曲率γは、プラス値が右方向、マイナス値が左方向を示す。したがって、カーブ路の曲がる方向はカーブ半径R、道路曲率γから判断でき、カーブ半径R、道路曲率γがプラス値の場合が右曲がりのカーブ路であり、マイナス値の場合が左曲がりのカーブ路である。ヨー角θは、プラス値が左方向であり、マイナス値が右方向である。オフセットD(オフセットDの積分値)は、プラス値が車線の左側であり、マイナス値が車線の右側である。本実施の形態では、CCDカメラ20及び画像処理部21が特許請求の範囲に記載する走行路検出手段、ずれ量検出手段、カーブ半径検出手段、カーブ方向検出手段に相当する。
The curve radius R, the road curvature γ, the yaw angle θ, and the offset D are represented by plus / minus values, and the sign indicates the direction. As for the curve radius R and the road curvature γ, a positive value indicates the right direction and a negative value indicates the left direction. Therefore, the direction of the curve road can be determined from the curve radius R and the road curvature γ. When the curve radius R and the road curvature γ are positive values, the curve road is a right turn, and when the curve radius is negative, the curve road is a left turn. It is. The yaw angle θ has a positive value in the left direction and a negative value in the right direction. The offset D (integrated value of the offset D) has a positive value on the left side of the lane and a negative value on the right side of the lane. In the present embodiment, the
ECU30は、CPU[Central Processing Unit]、ROM[Read Only Memory]、RAM[Random AccessMemory]などからなり、レーンキープ装置1を統括制御する。ECU30では、一定時間毎に、画像処理部21からの画像信号を取り入れるとともに、各センサ10,11から検出信号を取り入れる。そして、ECU30では、ドライバによる操作によってレーンキープ装置1が起動されている場合、車両が車線の中央付近を走行するように、画像信号に示される各種情報(道路曲率γ、ヨー角θ、オフセットD)及び車速Vに基づいて出力トルク(目標横加速度)を設定し、出力トルクを示す出力トルク信号を電動パワーステアリング装置40(EPSECU41)に送信する。
The
図2を参照して、ECU30における出力トルクを求めるための基本的な処理について説明する。なお、本実施の形態では、ECU30におけるこの基本的な処理が特許請求の範囲に記載する演算手段に相当する。
With reference to FIG. 2, a basic process for obtaining the output torque in the
ECU30では、F/Fコントローラ31において道路曲率γと車速Vとの乗算値にゲインKγを乗算し、ヨーレートωγを演算する。ヨーレートωγは、車両をカーブに沿って走行させるために必要となる目標横加速度を発生させるヨーレートであり、直線路では0になる。また、ヨーレートωγは、レーンキープのフィードフォワード出力となる。なお、フィードフォワード出力には、上限が設定されている。
In
ECU30では、オフセットDと目標オフセットD0(例えば、0)との偏差ΔD=(D0−D)を演算する。そして、ECU30では、積分器32において偏差ΔDを時間積分し、オフセットの積分値IDを演算する。さらに、ECU30では、積分値IDにゲインKIDを乗算するとともに偏差ΔDにゲインKDを乗算し、その2つの乗算値を加算してヨーレートωDを演算する。ヨーレートωDは、オフセット(積分値)を収束させるために必要となる目標横加速度を発生させるヨーレートである。特に、積分値IDに基づいて発生する目標横加速度は、路面カントの影響やフィードフォワード不足などを補償するための目標横加速度である。なお、本実施の形態では、積分器32が特許請求の範囲に記載する積分手段に相当する。
The
ECU30では、ヨー角θと目標ヨー角θ0(例えば、0)との偏差Δθ=(θ0−θ)を演算する。そして、ECU30では、偏差ΔθにゲインKθを乗算し、ヨーレートωθを演算する。ヨーレートωθは、ヨー角を収束させるために必要となる目標横加速度を発生させるヨーレートである。ヨーレートωDとヨーレートωθは、レーンキープのフィードバック出力となる。
The
ECU30では、求めた3つのヨーレートωγ,ωD,ωθを合算し、目標ヨーレートωを演算する。そして、ECU30では、目標横加速度演算器33において目標ヨーレートωに車速Vを乗算し、目標横加速度Gを演算する。目標横加速度Gは、プラス値/マイナス値で表され、その符号が方向を示す。目標横加速度Gは、プラス値が右方向への横加速度、マイナス値が左方向への横加速度を示す。この目標横加速度Gの変化によって、レーンキープによる操舵機構に付加する出力トルクの方向(レーンキープ操舵方向)が決まる。例えば、目標横加速度が所定量以上増加する場合には右方向に出力トルクを付加し、目標横加速度が所定量以上減少する場合には左方向に出力トルクを付加する。
The
ECU30では、出力トルク演算器34において目標横加速度Gに応じた出力トルクTを求める。出力トルク演算器34には、図3に示す出力トルクマップが保持されており、出力トルクマップを参照し、出力トルクマップから目標横加速度Gに応じた出力トルクTを求める。出力トルクマップとしては、切り増し時のマップTIと切り戻し時のマップTRとが設定されており、2つのマップTI,TRとの間にはヒステリシスが設けられている。このヒステリシスは、操舵機構における摩擦を補償するためのものであり、切り増し時に出力トルクを増加させ、切り戻し時に出力トルクを減少させる。また、出力トルクマップは、出力トルクT(目標横加速度G)がプラス側に増加する方向がレーンキープの操舵方向が右方向であり、出力トルクT(目標横加速度G)がマイナス側に増加する方向がレーンキープの操舵方向が左方向である。出力トルク演算器34では、レーンキープ操舵方向と目標横加速度Gの符号によって切り増し時のマップTIかあるいは切り戻し時のマップTRかのいずれかのマップを選択する。そして、出力トルク演算器34では、選択したマップから、目標横加速度Gの値に応じた出力トルクTを抽出する。そして、ECU30では、出力トルクTを示す出力トルク信号をEPSECU41に送信する。
In the
特に、ECU30では、カーブ出口又はカーブ出口付近で不要な積分値IDに基づく出力トルクを付加しないために、カーブ出口又はカーブ出口付近で必要に応じて積分値IDをリセットする。そのために、ECU30では、一定時間毎に、積分器32での処理の前に小Rカーブ判定処理、大Rカーブ判定処理、車両進行方向判定処理、ドライバ操舵方向判定処理、カーブ出口付近判定処理、積分出力リセット判定処理を行い、積分器32において積分出力リセット処理を行う。ここでは、ECU30における不要な積分値IDをリセットするための処理の概要について説明し、上記した各処理の詳細についてはレーンキープ装置1の動作説明のときに説明する。
In particular, the
なお、本実施の形態では、ECU30における車両進行方向判定処理が特許請求の範囲に記載する車両進行方向検出手段に相当し、ECU30における小Rカーブ判定処理及び積分出力リセット判定処理が特許請求の範囲に記載するカーブ出口判断手段に相当し、ECU30におけるドライバ操舵方向判定処理が特許請求の範囲に記載する操舵方向検出手段に相当する。
In the present embodiment, the vehicle traveling direction determination process in the
ECU30では、小Rカーブ旋回フラグ、カーブ旋回フラグ、車両右側進行フラグ、車両左側進行フラグ、ドライバ右操舵フラグ、ドライバ左操舵フラグ、カーブ出口付近フラグ、積分出力リセットフラグの8つのフラグを用いる。ECU30では、一定時間毎に、各処理において各フラグを設定する。また、ECU30では、一定時間毎に、積分出力リセットフラグ以外の7つのフラグについては各フラグの前回値も更新する。
The
小Rカーブ旋回フラグは、走行路が比較的急なカーブ(以下、「小Rカーブ」と記載)か否かのフラグであり、小Rカーブ旋回中の場合にはONであり、小Rカーブ旋回中でない場合にはOFFである。カーブ旋回フラグは、走行路が比較的緩やかなカーブ(以下、「大Rカーブ」と記載)か否かのフラグであり、大Rカーブ旋回中の場合にはONであり、大Rカーブ旋回中でない場合(直線路走行中の場合)にはOFFである。ちなみに、小Rカーブ旋回フラグがONの場合にはカーブ旋回フラグも常時ONである。また、カーブ旋回フラグがOFFの場合には走行路は直線路である。 The small R curve turning flag is a flag indicating whether or not the traveling path is a relatively steep curve (hereinafter referred to as “small R curve”), and is ON when the small R curve is turning. OFF when not turning. The curve turning flag is a flag indicating whether or not the traveling path is a relatively gentle curve (hereinafter, referred to as “large R curve”), and is ON when the large R curve is turning, and during the large R curve turning. Otherwise (when running on a straight road), it is OFF. Incidentally, when the small R curve turning flag is ON, the curve turning flag is always ON. Further, when the curve turning flag is OFF, the traveling road is a straight road.
車両右側進行フラグは、車両が車線の右側へ進行しているか否かのフラグであり、右側に進行中の場合にはONであり、右側に進行していない場合にはOFFである。車両左側進行フラグは、車両が車線の左側へ進行しているか否かのフラグであり、左側に進行中の場合にはONであり、左側に進行していない場合にはOFFである。車両右側進行フラグと車両左側進行フラグが共にOFFの場合には車両は直進中である。 The vehicle rightward progress flag is a flag indicating whether or not the vehicle is traveling to the right side of the lane, and is ON when the vehicle is traveling to the right side, and is OFF when the vehicle is not traveling to the right side. The vehicle left side progress flag is a flag indicating whether or not the vehicle is traveling to the left side of the lane, and is ON when the vehicle is traveling to the left side, and is OFF when the vehicle is not traveling to the left side. When both the vehicle right side progress flag and the vehicle left side progress flag are OFF, the vehicle is traveling straight.
ドライバ右操舵フラグは、ドライバがステアリングホイール2を右方向に操舵中か否かのフラグであり、右方向に操舵中の場合にはONであり、右方向に操舵していない場合にはOFFである。ドライバ左操舵フラグは、ドライバがステアリングホイール2を左方向に操舵中か否かのフラグであり、左方向に操舵中の場合にはONであり、左方向に操舵していない場合にはOFFである。ちなみに、ドライバ右操舵フラグとドライバ左操舵フラグが共にOFFの場合はドライバによる操舵力が入力されていない状態である。
The driver right steering flag is a flag indicating whether or not the driver is steering the
カーブ出口付近フラグは、車両がカーブ路旋回中にカーブ出口に到達していないが、カーブ出口に接近した位置(以下、「カーブ出口付近」と記載)に到達したか否かのフラグであり、カーブ出口付近の場合にはONであり、カーブ出口付近でない場合にはOFFである。積分出力リセットフラグは、積分値IDをリセットするか否かのフラグであり、リセットする場合にはONであり、リセットしない場合にはOFFである。 The curve exit flag is a flag indicating whether or not the vehicle has not reached the curve exit while turning on a curved road, but has reached a position close to the curve exit (hereinafter referred to as “around the curve exit”). It is ON when near the curve exit, and OFF when not near the curve exit. The integration output reset flag is a flag for determining whether or not to reset the integration value ID, and is ON when resetting, and is OFF when not resetting.
一定時間毎に、ECU30では、小Rカーブ判定処理により道路曲率に基づいて小Rカーブ旋回中であるか否かを判定し、小Rカーブ旋回フラグを設定する。また、ECU30では、大Rカーブ判定処理により道路曲率に基づいてカーブ旋回中であるか否かを判定し、カーブ旋回フラグを設定する。また、ECU30では、車両進行方向判定処理によりヨー角θに基づいて車両が右方向に進行しているか否か及び車両が左方向に進行しているか否か判定し、車両右側進行フラグ及び車両左側進行フラグを設定する。また、ECU30では、ドライバ操舵方向判定処理によりドライバによって入力された操舵トルクに基づいてドライバが右回転方向に操舵しているか否か及び左回転方向に操舵しているか否かを判定し、ドライバ右操舵フラグ及びドライバ左操舵フラグを設定する。
At certain time intervals, the
そして、ECU30では、カーブ出口付近判定処理により道路曲率の変化に基づいて車両がカーブ出口付近に到達したか否かを判定し、カーブ出口付近フラグを設定する。カーブ路の場合には道路曲率が0かあるいは0近傍から増加し、最大道路曲率となった後に、最大道路曲率から減少し、0かあるいは0近傍になるという道路曲率の変化を利用し、道路曲率の変化を観測することによってカーブ出口付近を判定する。
Then, the
さらに、ECU30では、積分出力リセット判定処理により小Rカーブ旋回フラグとその前回値に基づいて小Rカーブかつカーブ出口であるか否かを判定し、この判定条件を満たす場合には積分出力リセットフラグにONを設定する。小Rカーブでは、車両が高車速やカーブ半径が小さいほど、フィードフォワード出力の上限の影響により、フィードフォワード出力不足が発生する場合がある。この場合、車両の車線の外側にオフセットOF1が発生し、カーブ外側の積分値が増加し、この積分項に基づいてカーブの内側方向のトルクが付加される(図13参照)。そのため、車両が小Rカーブのカーブ出口から直線路や曲がる方向の異なるカーブに進入すると、その小Rカーブの内側方向に付加されるレーンキープのトルクの作用により、カーブ巻き込みが発生する可能性がある(図13の車両の走行軌跡ML1’参照)。また、小Rカーブでは、カーブ内側に低い路面カントの傾斜が大きいほど、路面カントによって車両に作用するカーブ内側方向の横加速度が大きくなる。この場合、車両の車線の内側にオフセットOF2が大きくなり、カーブ内側の積分値が増加し、この積分項に基づいてカーブの外側方向のトルクが付加される(図14参照)。そのため、車両が小Rカーブのカーブ出口から直線路や曲がる方向の異なるカーブに進入すると、その小Rカーブの外側方向に付加されるトルクの作用により、車線逸脱が発生する可能性がある(図14の車両の走行軌跡ML2’参照)。そこで、レーンキープ装置1では、小Rカーブのカーブ出口において積分項を必ずリセットし、不要な積分項に基づくフィードバック出力を無くす。
Further, the
さらに、ECU30では、積分出力リセット判定処理により小Rカーブ旋回フラグとカーブ出口付近フラグに基づいて小Rカーブのカーブ出口付近か否かを判定し、小Rカーブのカーブ出口付近の場合にはカーブ半径R、積分値ID、ドライバ右操舵フラグ、ドライバ左操舵フラグに基づいて積分値に基づく付加トルクが作用する方向がカーブの方向と一致しかつドライバの操舵方向がカーブの方向と一致していないか否かを判定し、この判定条件を満たす場合には積分出力リセットフラグにONを設定する。小Rカーブの中でも特に積分値に基づく付加トルクを作用する方向とカーブの方向とが一致する場合(つまり、積分項に基づいてカーブの内側方向にトルクが付加される場合)、小さいカーブ半径や高車速ほど、カーブ巻き込みが発生する可能性が高くなる。さらに、ドライバが小Rカーブの方向に操舵していない場合、ドライバは小Rカーブから次に進入する直進路かあるいはカーブに備えている。特に、カーブ半径が小さいほど、ドライバはカーブ出口の手前でステアリングホイール2を切り戻す。逆に、ドライバが小Rカーブの方向に操舵している場合、積分項に基づく付加トルクを無くすのは操舵フィーリング上好ましくない。そこで、レーンキープ装置1では、小Rカーブの場合でも、カーブ出口付近において上記条件を満たす場合には積分項をリセットするタイミングをカーブ出口より早め、不要な積分項によるフィードバック出力を早めに無くす。
Further, the
さらに、ECU30では、積分出力リセット判定処理によりカーブ旋回フラグとその前回値に基づいて大Rカーブのカーブ出口か否かを判定し、大Rカーブのカーブ出口の場合には積分値ID、車両右側進行フラグ、車両左側進行フラグに基づいて積分値に基づく付加トルクが作用する方向が車両の進行方向と一致するか否かを判定し、この判定条件を満たす場合には積分出力リセットフラグにONを設定する。大Rカーブの場合、大きなカーブ半径ほど、フィードフォワード出力不足が発生しない。また、大Rカーブでは、カーブ内側に低い路面カントの傾斜が小さいので、路面カントによって車両に作用するカーブ内側方向の横加速度が小さく、車線逸脱が発生しない。そこで、レーンキープ装置1では、基本的には、大Rカーブのカーブ出口において積分項をリセットせず、積分項に基づくフィードバック出力を作用させる。しかし、車両の進行方向と積分項に基づく付加トルクの方向とが同方向のときには、その積分項に基づく付加トルクによって車両の進行方向側に車両が更に操舵制御され、車両の進行方向側のオフセットが大きくなる。そこで、レーンキープ装置1では、大Rカーブの場合でも、上記条件を満たす場合には積分項をリセットし、不要な積分項によるフィードバック出力を無くす。
Further, the
積分出力リセットフラグを設定すると、ECU30の積分器32では、積分出力リセット処理により積分出力リセットフラグに基づいて積分値IDをリセットあるいはオフセットDの時間積分を継続する。
When the integral output reset flag is set, the
図1〜図3を参照して、レーンキープ装置1における動作について説明する。特に、ECU30における小Rカーブ判定処理について図4のフローチャートに沿って説明し、大Rカーブ判定処理については図5のフローチャートに沿って説明し、車両進行方向判定処理については図6及び図7のフローチャートに沿って説明し、ドライバ操舵方向判定処理については図8及び図9のフローチャートに沿って説明し、カーブ出口付近判定処理については図10のフローチャートに沿って説明し、積分出力リセット判定処理については図11のフローチャートに沿って説明し、積分出力リセット処理については図12のフローチャートに沿って説明する。図4は、図1のレーンキープ装置のECUにおける小Rカーブ判定処理の流れを示すフローチャートである。図5は、図1のレーンキープ装置のECUにおける大Rカーブ判定処理の流れを示すフローチャートである。図6は、図1のレーンキープ装置のECUにおける車両進行方向判定処理の右側進行判定部分の流れを示すフローチャートである。図7は、図1のレーンキープ装置のECUにおける車両進行方向判定処理の左側進行判定部分の流れを示すフローチャートである。図8は、図1のレーンキープ装置のECUにおけるドライバ操舵方向判定処理の右操舵判定部分の流れを示すフローチャートである。図9は、図1のレーンキープ装置のECUにおけるドライバ操舵方向判定処理の左操舵判定部分の流れを示すフローチャートである。図10は、図1のレーンキープ装置のECUにおけるカーブ出口付近判定処理の流れを示すフローチャートである。図11は、図1のレーンキープ装置のECUにおける積分出力リセット判定処理の流れを示すフローチャートである。図12は、図1のレーンキープ装置のECUにおける積分出力リセット処理の流れを示すフローチャートである。
The operation of the lane keeping device 1 will be described with reference to FIGS. In particular, the small R curve determination process in the
操舵トルクセンサ10では、ステアリングホイール2から入力される操舵トルクを検出し、その操舵トルクを示す操舵トルク信号をECU30に送信する。車速センサ11では、車速を検出し、その車速を示す車速信号をECU30に送信する。
The
CCDカメラ20では、車両の前方を撮像し、その撮像画像のデータを撮像信号として画像処理部21に送信する。画像処理部21では、撮像画像から車線を区画する一対の白線を認識する。そして、画像処理部21では、一対の白線から車線幅、車線の中心線、車線中心のカーブ半径Rと道路曲率γ、ヨー角θ及び車両のオフセットDを演算する。さらに、画像処理部21では、これら一対の白線の情報や演算した各情報を画像信号としてECU30に送信する。
The
ECU30では、一定時間毎に、操舵トルク信号、車速信号及び画像信号を受信する。そして、ECU30では、操舵トルク、車速及び画像信号からカーブ半径R、道路曲率γ、ヨー角θ、オフセットDを取得し、これらの各入力データをそれぞれフィルタ処理する。
The
ECU30では、一定時間毎に、小Rカーブ旋回フラグ(前回値)を前回設定された小Rカーブ旋回フラグの値で更新する(図4のS10)。そして、ECU30では、小Rカーブ旋回フラグ(前回値)=OFFかつ道路曲率γの絶対値がC1より大きいか否かを判定する(図4のS11)。C1は、道路曲率によって走行路が小Rカーブであるかを判定するための閾値である。S11の判定条件を満たす場合、ECU30では、小Rカーブ判定成立タイマをインクリメントする(図4のS12)。一方、S11の判定条件を満たさない場合、ECU30では、小Rカーブ判定成立タイマをリセットする(図4のS13)。小Rカーブ判定成立タイマは、前回の小Rカーブ判定フラグがOFFの場合に道路曲率γの絶対値がC1より大きい状態がある程度継続したときに小Rカーブ旋回中と判定するためのタイマである。道路曲率γは、撮像画像から認識された車線から求められるので、カメラノイズの影響を受けている場合がある。そこで、道路曲率γの絶対値がC1より大きいと所定回数継続して判定された場合だけ、車両が小Rカーブ旋回中と判定する。
The
ECU30では、小Rカーブ旋回フラグ(前回値)=ONかつ道路曲率γの絶対値がC2より小さいか否かを判定する(図4のS14)。C2は、道路曲率によって走行路が小Rカーブでないかを判定するための閾値であり、C1より小さい値である。S14の判定条件を満たす場合、ECU30では、小Rカーブ判定解除タイマをインクリメントする(図4のS15)。一方、S14の判定条件を満たさない場合、ECU30では、小Rカーブ判定解除タイマをリセットする(図4のS16)。小Rカーブ判定解除タイマは、前回の小Rカーブ判定フラグがONの場合に道路曲率γの絶対値がC2より小さい状態がある程度継続したときに小Rカーブ旋回中でないと判定するためのタイマである。上記したように道路曲率γはカメラノイズの影響を受けている場合があるので、道路曲率γの絶対値がC2より小さいと所定回数継続して判定された場合だけ、車両が小Rカーブ旋回中でないと判定する。
The
ECU30では、小Rカーブ旋回フラグ(前回値)=OFFか否かを判定する(図4のS17)。S17にて小Rカーブ旋回フラグ(前回値)=OFFと判定した場合、ECU30では、小Rカーブ判定成立タイマがT0より大きいか否かを判定する(図4のS18)。S18にて小Rカーブ判定成立タイマがT0より大きいと判定した場合、前回の小Rカーブ判定フラグがOFFの場合に道路曲率γの絶対値がC1より大きい状態が所定時間継続したので、ECU30では、小Rカーブ旋回フラグにON(小Rカーブ旋回中)を設定する(図4のS20)。一方、S18にて小Rカーブ判定成立タイマがT0以下と判定した場合、前回の小Rカーブ判定フラグがOFFの場合に道路曲率γの絶対値がC1より大きい状態が所定時間継続していないので、ECU30では、小Rカーブ旋回フラグにOFF(小Rカーブ旋回中でない)を設定する(図4のS21)。T0は、道路曲率γがC1(C3)より大きい状態が所定時間継続していることを判定するための閾値である。
The
一方、S17にて小Rカーブ旋回フラグ(前回値)=ONと判定した場合、ECU30では、小Rカーブ判定解除タイマがT1より大きいか否かを判定する(図4のS19)。S19にて小Rカーブ判定解除タイマがT1より大きいと判定した場合、前回の小Rカーブ判定フラグがONの場合に道路曲率γの絶対値がC2より小さい状態が所定時間継続したので、ECU30では、小Rカーブ旋回フラグにOFF(小Rカーブ旋回中でない)を設定する(図4のS21)。一方、S19にて小Rカーブ判定解除タイマがT1以下と判定した場合、前回の小Rカーブ判定フラグがONの場合に道路曲率γの絶対値がC2より小さい状態が所定時間継続していないので、ECU30では、小Rカーブ旋回フラグにON(小Rカーブ旋回中)を設定する(図4のS20)。T1は、道路曲率γがC2(C4)より小さい状態が所定時間継続していることを判定するための閾値である。
On the other hand, when it is determined in S17 that the small R curve turning flag (previous value) = ON, the
次に、ECU30では、一定時間毎に、カーブ旋回フラグ(前回値)を前回設定されたカーブ旋回フラグの値で更新する(図5のS30)。そして、ECU30では、カーブ旋回フラグ(前回値)=OFFかつ道路曲率γの絶対値がC3より大きいか否かを判定する(図5のS31)。C3は、道路曲率によって走行路が大Rカーブであるかを判定するための閾値であり、C1より小さい値である。S31の判定条件を満たす場合、ECU30では、カーブ判定成立タイマをインクリメントする(図5のS32)。一方、S31の判定条件を満たさない場合、ECU30では、カーブ判定成立タイマをリセットする(図5のS33)。カーブ判定成立タイマは、前回のカーブ判定フラグがOFFの場合に道路曲率γの絶対値がC3より大きい状態がある程度継続したときにカーブ旋回中と判定するためのタイマである。上記したように道路曲率γはカメラノイズの影響を受けている場合があるので、道路曲率γの絶対値がC3より大きいと所定回数継続して判定された場合だけ、車両が大Rカーブ旋回中と判定する。
Next, the
ECU30では、カーブ旋回フラグ(前回値)=ONかつ道路曲率γの絶対値がC4より小さいか否かを判定する(図5のS34)。C4は、道路曲率によって走行路が大Rカーブでないかを判定するための閾値であり(つまり、走行路が直線路であるかを判定するための閾値であり)、C2及びC3より小さい値である。S34の判定条件を満たす場合、ECU30では、カーブ判定解除タイマをインクリメントする(図5のS35)。一方、S34の判定条件を満たさない場合、ECU30では、カーブ判定解除タイマをリセットする(図5のS36)。カーブ判定解除タイマは、前回のカーブ判定フラグがONの場合に道路曲率γの絶対値がC4より小さい状態がある程度継続したときにカーブ旋回中でないと判定するためのタイマである。上記したように道路曲率γはカメラノイズの影響を受けている場合があるので、道路曲率γの絶対値がC4より小さいと所定回数継続して判定された場合だけ、車両が大Rカーブ旋回中でない(直進路走行中)と判定する。
The
ECU30では、カーブ旋回フラグ(前回値)=OFFか否かを判定する(図5のS37)。S37にてカーブ旋回フラグ(前回値)=OFFと判定した場合、ECU30では、カーブ判定成立タイマがT0より大きいか否かを判定する(図5のS38)。S38にてカーブ判定成立タイマがT0より大きいと判定した場合、前回のカーブ判定フラグがOFFの場合に道路曲率γの絶対値がC3より大きい状態が所定時間継続したので、ECU30では、カーブ旋回フラグにON(大Rカーブ旋回中)を設定する(図5のS40)。一方、S38にてカーブ判定成立タイマがT0以下と判定した場合、前回のカーブ判定フラグがOFFの場合に道路曲率γの絶対値がC3より大きい状態が所定時間継続していないので、ECU30では、カーブ旋回フラグにOFF(大Rカーブ旋回中でない)を設定する(図5のS41)。
The
一方、S37にてカーブ旋回フラグ(前回値)=ONと判定した場合、ECU30では、カーブ判定解除タイマがT1より大きいか否かを判定する(図5のS39)。S39にてカーブ判定解除タイマがT1より大きいと判定した場合、前回のカーブ判定フラグがONの場合に道路曲率γの絶対値がC4より小さい状態が所定時間継続したので、ECU30では、カーブ旋回フラグにOFF(大Rカーブ旋回中でない)を設定する(図5のS41)。一方、S39にてカーブ判定解除タイマがT1以下と判定した場合、前回のカーブ判定フラグがONの場合に道路曲率γの絶対値がC4より小さい状態が所定時間継続していないので、ECU30では、カーブ旋回フラグにON(大Rカーブ旋回中)を設定する(図5のS40)。
On the other hand, when it is determined in S37 that the curve turning flag (previous value) = ON, the
次に、ECU30では、一定時間毎に、車両右側進行フラグ(前回値)=OFFか否か判定する(図6のS50)。S50にて車両右側進行フラグ(前回値)=OFFと判定した場合、ECU30では、車両のヨー角θが−Ang1より小さいか否かを判定する(図6のS51)。Ang1(プラス値)は、ヨー角によって車両の進行方向が車線の右側かあるいは左側かを判定するための閾値である。ヨー角θは、プラス値が左側であり、マイナス値が右側である。したがって、ヨー角がAng1より大きい場合には車両進行方向を左側と判定できるほどの左側のヨー角が発生し、−Ang1より小さい場合には車両進行方向を右側と判定できるほどの右側のヨー角が発生していることを示す。
Next, the
S51にてヨー角θが−Ang1より小さいと判定した場合、ECU30では、右側進行判定成立タイマをインクリメントする(図6のS52)。一方、S51にてヨー角θが−Ang1以上と判定した場合、ECU30では、右側進行判定成立タイマをリセットする(図6のS53)。右側進行判定成立タイマは、前回の車両右側進行フラグがOFFの場合にヨー角θが−Ang1より小さい状態がある程度継続したときに車両が車線の右側を進行中と判定するためのタイマである。ヨー角θは、撮像画像から認識された車線から求められるので、カメラノイズの影響を受けている場合がある。そこで、ヨー角θが−Ang1より小さいと所定回数継続して判定された場合だけ、車両が車線の右側を進行中と判定する。
When it is determined in S51 that the yaw angle θ is smaller than −Ang1, the
そして、ECU30では、右側進行判定成立タイマがT2より大きいか否かを判定する(図6のS54)。S54にて右側進行判定成立タイマがT2より大きいと判定した場合、前回の車両右側進行判定フラグがOFFの場合にヨー角θが−Ang1より小さい状態が所定時間継続したので、ECU30では、車両右側進行フラグにON(車両が車両の右側進行中)を設定する(図6のS56)。一方、S54にて右側進行判定成立タイマがT2以下と判定した場合、前回の車両右側進行判定フラグがOFFの場合にヨー角θが−Ang1より小さい状態が所定時間継続していないので、ECU30では、車両右側進行フラグにOFF(車両が車線の右側を進行していない)を設定する(図6のS57)。T2は、ヨー角θが−Ang1より小さい状態(ヨー角θがAng1より大きい状態)が所定時間継続していることを判定するための閾値である。
Then, the
一方、S50にて車両右側進行フラグ(前回値)=ONと判定した場合、ECU30では、車両のヨー角θが−Ang2より大きいか否かを判定する(図6のS55)。Ang2(プラス値)は、ヨー角によって車両の進行方向が車線の右側でないあるいは左側でないことを判定するための閾値であり、Ang1より小さい値である。ヨー角θは、プラス値が左側であり、マイナス値が右側である。したがって、ヨー角がAng2より小さい場合には車両進行方向を左側と判定できるほどの左側のヨー角が発生していない、−Ang2より大きい場合には車両進行方向を右側と判定できるほどの右側のヨー角が発生していないことを示す。S55にて車両のヨー角θが−Ang2より大きいと判定した場合、前回の車両右側進行判定フラグがONの場合にヨー角θが−Ang2より大きくなったので、ECU30では、車両右側進行フラグにOFF(車両が車両の右側を進行していない)を設定する(図6のS57)。一方、S55にて車両のヨー角θが−Ang2以下と判定した場合、前回の車両右側進行判定フラグがONの場合に未だヨー角θが−Ang2以下なので、ECU30では、車両右側進行フラグにON(車両が車線の右側進行中)を設定する(図6のS56)。
On the other hand, when it is determined in S50 that the vehicle right side advance flag (previous value) = ON, the
そして、ECU30では、車両右側進行フラグ(前回値)を今回設定した車両右側進行フラグの値で更新する(図6のS58)。
Then, the
続いて、ECU30では、車両左側進行フラグ(前回値)=OFFか否か判定する(図7のS59)。S59にて車両左側進行フラグ(前回値)=OFFと判定した場合、ECU30では、車両のヨー角θがAng1より大きいか否かを判定する(図7のS60)。
Subsequently, the
S60にてヨー角θがAng1より大きいと判定した場合、ECU30では、左側進行判定成立タイマをインクリメントする(図7のS61)。一方、S60にてヨー角θがAng1以下と判定した場合、ECU30では、左側進行判定成立タイマをリセットする(図7のS62)。左側進行判定成立タイマは、前回の車両左側進行フラグがOFFの場合にヨー角θがAng1より大きい状態がある程度継続したときに車両が車線の左側を進行中と判定するためのタイマである。上記したようにヨー角θはカメラノイズの影響を受ける場合があるので、ヨー角θがAng1より大きいと所定回数継続して判定された場合だけ、車両が車線の左側を進行中と判定する。
When it is determined in S60 that the yaw angle θ is larger than Ang1, the
そして、ECU30では、左側進行判定成立タイマがT2より大きいか否かを判定する(図7のS63)。S63にて左側進行判定成立タイマがT2より大きいと判定した場合、前回の車両左側進行判定フラグがOFFの場合にヨー角θがAng1より大きい状態が所定時間継続したので、ECU30では、車両左側進行フラグにON(車両が車両の左側進行中)を設定する(図7のS65)。一方、S63にて左側進行判定成立タイマがT2以下と判定した場合、前回の車両左側進行判定フラグがOFFの場合にヨー角θがAng1より大きい状態が所定時間継続していないので、ECU30では、車両左側進行フラグにOFF(車両が車線の左側を進行していない)を設定する(図7のS66)。
Then, the
一方、S59にて車両左側進行フラグ(前回値)=ONと判定した場合、ECU30では、車両のヨー角θがAng2より小さいか否かを判定する(図7のS64)。S64にて車両のヨー角θがAng2より小さいと判定した場合、前回の車両左側進行判定フラグがONの場合にヨー角θがAng2より小さくなったので、ECU30では、車両左側進行フラグにOFF(車両が車両の左側を進行していない)を設定する(図7のS66)。一方、S64にて車両のヨー角θがAng2以上と判定した場合、前回の車両左側進行判定フラグがONの場合に未だヨー角θがAng2以上なので、ECU30では、車両左側進行フラグにON(車両が車線の左側進行中)を設定する(図7のS65)。
On the other hand, when it is determined in S59 that the vehicle left side advance flag (previous value) = ON, the
そして、ECU30では、車両左側進行フラグ(前回値)を今回設定した車両左側進行フラグの値で更新する(図7のS67)。
Then, the
次に、ECU30では、一定時間毎に、ドライバ右操舵フラグ(前回値)=OFFか否か判定する(図8のS70)。S70にてドライバ右操舵フラグ(前回値)=OFFと判定した場合、ECU30では、ドライバの操舵トルクがMT1より大きいか否かを判定する(図8のS71)。MT1(プラス値)は、ドライバによる操舵トルクによってドライバによる操舵方向が右方向かあるいは左方向かを判定するための閾値である。操舵トルクは、プラス値が右方向であり、マイナス値が左方向である。したがって、操舵トルクがMT1より大きい場合にはドライバの操舵方向を右方向と判定できるほどの右方向の操舵トルクが発生し、−MT1より小さい場合にはドライバの操舵方向を左方向と判定できるほどの左方向の操舵トルクが発生していることを示す。
Next, the
S71にて操舵トルクがMT1より大きいと判定した場合、ECU30では、ドライバ右操舵判定成立タイマをインクリメントする(図8のS72)。一方、S71にて操舵トルクがMT1以下と判定した場合、ECU30では、ドライバ右操舵判定成立タイマをリセットする(図8のS73)。ドライバ右操舵判定成立タイマは、前回のドライバ右操舵フラグがOFFの場合に操舵トルクがMT1より大きい状態がある程度継続したときにドライバが右方向に操舵していると判定するためのタイマである。操舵トルクセンサ10によって検出された操舵トルクにはノイズが含まれている場合があるので、操舵トルクがMT1より大きいと所定回数継続して判定された場合だけ、ドライバが右方向に操舵中と判定する。
If it is determined in S71 that the steering torque is greater than MT1, the
そして、ECU30では、ドライバ右操舵判定成立タイマがT3より大きいか否かを判定する(図8のS74)。S74にてドライバ右操舵判定成立タイマがT3より大きいと判定した場合、前回のドライバ右操舵フラグがOFFの場合に操舵トルクがMT1より大きい状態が所定時間継続したので、ECU30では、ドライバ右操舵フラグにON(ドライバが右方向に操舵中)を設定する(図8のS76)。一方、S74にてドライバ右操舵判定成立タイマがT3以下と判定した場合、前回のドライバ右操舵フラグがOFFの場合に操舵トルクがMT1より大きい状態が所定時間継続していないので、ECU30では、ドライバ右操舵フラグにOFF(ドライバが右方向に操舵していない)を設定する(図8のS77)。T3は、操舵トルクがMT1より大きい状態(操舵トルクが−MT1より小さい状態)が所定時間継続していることを判定するための閾値である。
Then, the
一方、S70にてドライバ右操舵フラグ(前回値)=ONと判定した場合、ECU30では、ドライバによる操舵トルクがMT2より小さいか否かを判定する(図8のS75)。MT2(プラス値)は、ドライバによる操舵トルクによってドライバによる操舵方向が右方向でないあるいは左方向でないことを判定するための閾値であり、MT1より小さい値である。操舵トルクは、プラス値が右方向であり、マイナス値が左方向である。したがって、操舵トルクがMT2より小さい場合にはドライバの操舵方向が右方向と判定できるほどの右方向の操舵トルクが発生していない、−MT2より大きい場合にはドライバの操舵方向を左方向と判定できるほどの左方向の操舵トルクが発生していないことを示す。S75にてドライバの操舵トルクがMT2より小さいと判定した場合、前回のドライバ右操舵フラグがONの場合に操舵トルクがMT2より小さくなったので、ECU30では、ドライバ右操舵フラグにOFF(ドライバが右方向に操舵していない)を設定する(図8のS77)。一方、S75にてドライバの操舵トルクがMT2以上と判定した場合、前回のドライバ右操舵フラグがONの場合に未だ操舵トルクがMT2以上なので、ECU30では、ドライバ右操舵フラグにON(ドライバが右方向に操舵中)を設定する(図8のS76)。
On the other hand, when it is determined in S70 that the driver right steering flag (previous value) = ON, the
そして、ECU30では、ドライバ右操舵フラグ(前回値)を今回設定したドライバ右操舵フラグの値で更新する(図8のS78)。
Then, the
続いて、ECU30では、ドライバ左操舵フラグ(前回値)=OFFか否か判定する(図9のS79)。S79にてドライバ左操舵フラグ(前回値)=OFFと判定した場合、ECU30では、ドライバの操舵トルクが−MT1より小さいか否かを判定する(図9のS80)。
Subsequently, the
S80にて操舵トルクが−MT1より小さいと判定した場合、ECU30では、ドライバ左操舵判定成立タイマをインクリメントする(図9のS81)。一方、S80にて操舵トルクが−MT1以上と判定した場合、ECU30では、ドライバ左操舵判定成立タイマをリセットする(図9のS82)。ドライバ左操舵判定成立タイマは、前回のドライバ左操舵フラグがOFFの場合に操舵トルクが−MT1より小さい状態がある程度継続したときにドライバが左方向に操舵していると判定するためのタイマである。上記したように操舵トルクにはノイズが含まれている場合があるので、操舵トルクが−MT1より小さいと所定回数継続して判定された場合だけ、ドライバが左方向に操舵中と判定する。
When it is determined in S80 that the steering torque is smaller than -MT1, the
そして、ECU30では、ドライバ左操舵判定成立タイマがT3より大きいか否かを判定する(図9のS83)。S83にてドライバ左操舵判定成立タイマがT3より大きいと判定した場合、前回のドライバ左操舵フラグがOFFの場合に操舵トルクが−MT1より小さい状態が所定時間継続したので、ECU30では、ドライバ左操舵フラグにON(ドライバが左方向に操舵中)を設定する(図9のS85)。一方、S83にてドライバ左操舵判定成立タイマがT3以下と判定した場合、前回のドライバ左操舵フラグがOFFの場合に操舵トルクが−MT1より小さい状態が所定時間継続していないので、ECU30では、ドライバ左操舵フラグにOFF(ドライバが左方向に操舵していない)を設定する(図9のS86)。
Then, the
一方、S79にてドライバ左操舵フラグ(前回値)=ONと判定した場合、ECU30では、ドライバによる操舵トルクが−MT2より大きいか否かを判定する(図9のS84)。S84にてドライバの操舵トルクが−MT2より大きいと判定した場合、前回のドライバ左操舵フラグがONの場合に操舵トルクが−MT2より大きくなったので、ECU30では、ドライバ左操舵フラグにOFF(ドライバが左方向に操舵していない)を設定する(図9のS86)。一方、S84にてドライバの操舵トルクが−MT2以下と判定した場合、前回のドライバ左操舵フラグがONの場合に未だ操舵トルクが−MT2以下なので、ECU30では、ドライバ左操舵フラグにON(ドライバが左方向に操舵中)を設定する(図9のS85)。
On the other hand, if it is determined in S79 that the driver left steering flag (previous value) = ON, the
そして、ECU30では、ドライバ左操舵フラグ(前回値)を今回設定したドライバ左操舵フラグの値で更新する(図9のS87)。
Then, the
次に、ECU30では、一定時間毎に、カーブ旋回フラグ=ONか否かを判定する(図10のS90)。S90にてカーブ旋回フラグがONと判定した場合(つまり、車両がカーブ旋回中の場合)、ECU30では、道路曲率γの絶対値がカーブ中最大曲率より大きいか否かを判定する(図10のS91)。カーブ中最大曲率は、車両がカーブ旋回中における走行路の最大の道路曲率を示し、カーブ旋回中に道路曲率γの絶対値が前回までに設定されているカーブ中最大曲率より大きくなる毎に更新される。S91にて道路曲率γの絶対値がカーブ中最大曲率より大きいと判定した場合、ECU30では、カーブ中最大曲率を道路曲率γの絶対値で更新する(図10のS92)。一方、S91にて道路曲率γの絶対値がカーブ中最大曲率以下と判定した場合、ECU30では、前回のカーブ中最大曲率を保持する。
Next, the
ECU30では、カーブ出口付近フラグ(前回値)=OFFか否かを判定する(図10のS93)。S93にてカーブ出口付近フラグ=OFFと判定した場合、ECU30では、カーブ出口付近判定解除タイマをリセットする(図10のS94)。そして、ECU30では、道路曲率γの絶対値が(Kr×カーブ中最大曲率)より小さいか否かを判定する(図10のS95)。Krは、カーブ旋回中に車両がカーブ出口付近に到達したか否かを判定するための係数であり、1より小さい値である。Krは、カーブ旋回フラグ(小Rカーブ旋回フラグ)がOFFになる前にカーブ出口付近フラグがONするように設定される。したがって、(Kr×カーブ中最大曲率)はカーブ中最大曲率より小さい値であり、道路曲率γの絶対値がカーブ中最大曲率から(Kr×カーブ中最大曲率)まで小さくなったときには車両がカーブ出口付近に到達したことを示す。
The
S95にて道路曲率γの絶対値が(Kr×カーブ中最大曲率)より小さいと判定した場合、ECU30では、カーブ出口付近判定成立タイマをインクリメントする(図10のS96)。一方、S95にて道路曲率の絶対値が(Kr×カーブ中最大曲率)以上と判定した場合、ECU30では、カーブ出口付近判定成立タイマをリセットする(図10のS97)。カーブ出口付近判定成立タイマは、前回のカーブ出口付近フラグがOFFの場合に道路曲率γの絶対値が(Kr×カーブ中最大曲率)より小さい状態がある程度継続したときに車両がカーブ出口付近に到達と判定するためのタイマである。上記したように道路曲率γはカメラノイズの影響を受けている場合があるので、道路曲率γの絶対値が(Kr×カーブ中最大曲率)より小さいと所定回数継続して判定された場合だけ、車両がカーブ出口付近と判定する。
When it is determined in S95 that the absolute value of the road curvature γ is smaller than (Kr × maximum curvature in the curve), the
そして、ECU30では、カーブ出口付近判定成立タイマがT4より大きいか否かを判定する(図10のS98)。S98にてカーブ出口付近判定成立タイマがT4より大きいと判定した場合、前回のカーブ出口付近フラグがOFFの場合に道路曲率γの絶対値が(Kr×カーブ中最大曲率)より小さい状態が所定時間継続したので、ECU30では、カーブ出口付近フラグにON(車両がカーブ出口付近)を設定する(図10のS104)。一方、S98にてカーブ出口付近判定成立タイマがT4以下と判定した場合、前回のカーブ出口付近フラグがOFFの場合に道路曲率γの絶対値が(Kr×カーブ中最大曲率)より小さい状態が所定時間継続していないので、ECU30では、カーブ出口付近フラグにOFF(車両がカーブ出口付近でない)を設定する(図10のS105)。T4は、道路曲率γの絶対値が(Kr×カーブ中最大曲率)より小さい状態が所定時間継続していることを判定するための閾値である。
Then, the
一方、S93にてカーブ出口付近フラグ=ONと判定した場合、ECU30では、カーブ出口付近判定成立タイマをリセットする(図10のS99)。そして、ECU30では、道路曲率γの絶対値が(Kr×カーブ中最大曲率)より大きいか否かを判定する(図10のS100)。
On the other hand, when it is determined in S93 that the curve exit vicinity flag is ON, the
S100にて道路曲率γの絶対値が(Kr×カーブ中最大曲率)より大きいと判定した場合、ECU30では、カーブ出口付近判定解除タイマをインクリメントする(図10のS101)。一方、S100にて道路曲率γの絶対値が(Kr×カーブ中最大曲率)以下と判定した場合、ECU30では、カーブ出口付近判定解除タイマをリセットする(図10のS102)。カーブ出口付近判定解除タイマは、前回のカーブ出口付近フラグがONの場合に道路曲率γの絶対値が(Kr×カーブ中最大曲率)より大きい状態がある程度継続したときに車両がカーブ出口付近に到達していないと判定するためのタイマである。上記したように道路曲率γはカメラノイズの影響を受けている場合があるので、道路曲率γの絶対値が(Kr×カーブ中最大曲率)より大きいと所定回数継続して判定された場合だけ、車両がカーブ出口付近でないと判定する。
When it is determined in S100 that the absolute value of the road curvature γ is larger than (Kr × maximum curvature in the curve), the
そして、ECU30では、カーブ出口付近判定解除タイマがT5より大きいか否かを判定する(図10のS103)。S103にてカーブ出口付近判定解除タイマがT5より大きいと判定した場合、前回のカーブ出口付近フラグがONの場合に道路曲率γの絶対値が(Kr×カーブ中最大曲率)より大きい状態が所定時間継続したので、ECU30では、カーブ出口付近フラグにOFF(車両がカーブ出口付近でない)を設定する(図10のS105)。一方、S103にてカーブ出口付近判定解除タイマがT5以下と判定した場合、前回のカーブ出口付近フラグがONの場合に道路曲率γの絶対値が(Kr×カーブ中最大曲率)より大きい状態が所定時間継続していないので、ECU30では、カーブ出口付近フラグにON(車両がカーブ出口付近)を設定する(図10のS104)。T5は、道路曲率γの絶対値が(Kr×カーブ中最大曲率)より大きい状態が所定時間継続していることを判定するための閾値である。
Then, the
一方、S90にてカーブ旋回フラグがOFFと判定した場合(つまり、車両が直線路走行中の場合)、ECU30では、カーブ中最大曲率を0にリセットし(図10のS106)、カーブ出口付近判定解除タイマをリセットし(図10のS107)、カーブ出口付近判定成立タイマをリセットし(図10のS108)、カーブ出口付近フラグにOFFを設定する(図10のS109)。
On the other hand, when it is determined in S90 that the curve turning flag is OFF (that is, when the vehicle is traveling on a straight road), the
そして、ECU30では、カーブ出口付近フラグ(前回値)を今回設定したカーブ出口付近フラグの値で更新する(図10のS110)。
Then, the
次に、ECU30では、一定時間毎に、小Rカーブ旋回フラグ(前回値)=ONかつ小Rカーブ旋回フラグ=OFFか否か(つまり、前回の判定で小Rカーブであったが今回の判定で小Rカーブでなくなったので、車両が小Rカーブの出口に到達したか否か)を判定する(図11のS120)。S120の判定条件を満たす場合、車両が小Rカーブの出口に到達したので、ECU30では、積分出力リセットフラグにONを設定する(図11のS128)。
Next, the
S120の判定条件を満たさない場合、ECU30では、小Rカーブ旋回フラグ=ONかつカーブ出口付近フラグ=ONか否か(つまり、車両が小Rカーブ旋回中にカーブ出口付近に到達したか否か)を判定する(図11のS121)。S120の判定条件を満たす場合、ECU30では、カーブ半径Rに基づいて左カーブ旋回中かつドライバ左操舵フラグがOFFかつ積分値IDが0より小さいか否か(つまり、車両が左カーブ旋回中にドライバが左方向に操舵しておらずかつ積分値IDに基づくレーンキープによる付加トルク方向が左方向か否か)を判定する(図11のS122)。S122の判定条件を満たす場合、左方向の小Rカーブ旋回中にカーブ出口付近に到達し、積分値IDに基づくレーンキープの付加トルク方向が左方向かつドライバが左操舵していないので、ECU30では、積分出力リセットフラグにONを設定する(図11のS128)。一方、S122の判定条件を満たさない場合、ECU30では、カーブ半径Rに基づいて右カーブ旋回中かつドライバ右操舵フラグがOFFかつ積分値IDが0より大きいか否か(つまり、車両が右カーブ旋回中にドライバが右方向に操舵しておらずかつ積分値IDに基づくレーンキープによる付加トルク方向が右方向か否か)を判定する(図11のS123)。S123の判定条件を満たす場合、右方向の小Rカーブ旋回中にカーブ出口付近に到達し、積分値IDに基づくレーンキープの付加トルク方向が右方向かつドライバが右操舵していないので、ECU30では、積分出力リセットフラグにONを設定する(図11のS128)。
If the determination condition of S120 is not satisfied, the
一方、S123の判定条件を満たさない場合、ECU30では、カーブ旋回フラグ(前回値)=ONかつカーブ旋回フラグ=OFFか否か(つまり、前回の判定で大Rカーブであったが今回の判定で大Rカーブでなくなったので、車両が大Rカーブの出口に到達したか否か)を判定する(図11のS124)。S124の判定条件を満たす場合、ECU30では、車両左側進行フラグ=ONかつ積分値IDが0より小さいか否か(つまり、車両の進行方向と積分値IDに基づくレーンキープによる付加トルク方向が共に左方向か否か)を判定する(図11のS125)。S125の判定条件を満たす場合、大Rカーブ旋回中にカーブ出口に到達し、車両の進行方向と積分値IDに基づくレーンキープによる付加トルク方向とが左方向で一致するので、ECU30では、積分出力リセットフラグにONを設定する(図11のS128)。一方、S125の判定条件を満たさない場合、ECU30では、車両右側進行フラグ=ONかつ積分値IDが0より大きいか否か(つまり、車両の進行方向と積分値IDに基づくレーンキープによる付加トルク方向が共に右方向か否か)を判定する(図11のS126)。S126の判定条件を満たす場合、大Rカーブ旋回中にカーブ出口に到達し、車両の進行方向と積分値IDに基づくレーンキープによる付加トルク方向とが右方向で一致するので、ECU30では、積分出力リセットフラグにONを設定する(図11のS128)。
On the other hand, when the determination condition of S123 is not satisfied, the
S124の判定条件を満たさない場合、カーブ旋回中の場合にカーブ出口あるいはカーブ出口付近に到達していない、または、カーブ旋回中でないので、ECU30では、積分出力リセットフラグにOFFを設定する(図11のS127)。また、S126の判定条件を満たさない場合、車両が大Rカーブの出口に到達したが、車両の進行方向と積分値IDに基づくレーンキープによる付加トルク方向とが一致しないので、ECU30では、積分出力リセットフラグにOFFを設定する(図11のS127)。
If the determination condition of S124 is not satisfied, the curve exit or the vicinity of the curve exit is not reached when the curve is turning, or the curve is not turning, so the
そして、ECU30のF/Fコントローラ31では、一定時間毎に、道路曲率γと車速Vの乗算値にゲインKγを乗算してヨーレートωγを演算する。
Then, the F /
また、ECU30では、ヨー角θと目標ヨー角θ0との偏差Δθ=(θ0−θ)を演算し、その偏差ΔθにゲインKθを乗算してヨーレートωθを演算する。
Further, the
また、ECU30では、オフセットDと目標オフセットD0との偏差ΔD=(D0−D)を演算する。そして、ECU30の積分器32では、積分出力リセットフラグがONか否かを判定する(図12のS130)。S130にて積分出力リセットフラグがONと判定した場合、積分器32では、積分値IDを0にリセットする(図12のS131)。ここで、小Rカーブの場合、カーブ出口で積分値IDが必ず0にリセットされ、特に、積分値IDに基づくレーンキープの付加トルクの方向がカーブ内側方向かつドライバがカーブ内側方向に操舵していないときにはカーブ出口に近づくと積分値IDが0に早めにリセットされる。大Rカーブの場合、カーブ出口でも基本的には積分値IDはリセットされないが、カーブ出口において車両の進行方向と積分値IDに基づくレーンキープの付加トルクの方向とが一致するときだけ積分値IDが0にリセットされる。これらのリセットによって、カーブ出口あるいはカーブ出口付近において、不要な積分値がなくなり、積分値に基づくレーンキープのトルクが操舵機構に付加されない。
Further, the
一方、S130にて積分出力リセットフラグがOFFと判定した場合、積分器32では、偏差ΔDを時間積分し、オフセットの積分値IDを演算する(図12のS132)。
On the other hand, when it is determined in S130 that the integration output reset flag is OFF, the
さらに、ECU30では、積分値IDにゲインKIDを乗算するとともに偏差ΔDにゲインKDを乗算し、その2つの乗算値を加算してヨーレートωDを演算する。
Further, the
ECU30では、求めた3つのヨーレートωγ,ωD,ωθを合算し、目標ヨーレートωを演算する。そして、ECU30の目標横加速度演算器33では、目標ヨーレートωに車速Vを乗算し、目標横加速度Gを演算する。さらに、ECU30の出力トルク演算器34では、レーンキープの操舵方向と目標横加速度Gの符号によって切り増し時のマップTIかあるいは切り戻し時のマップTRかを選択し、選択したマップを参照して目標横加速度Gの値に応じた出力トルクTを抽出する。そして、ECU30では、出力トルクTを示す出力トルク信号をEPSECU41に送信する。
The
EPSECU41では、出力トルク信号を受信し、その出力トルク信号に示される出力トルクに所定の係数を乗算する。そして、EPSECU41では、その乗算値(付加トルク)をアシストトルクに加算し、そのアシストトルク+付加トルクに応じてモータ42を駆動制御する。モータ42では、ECPECU41による制御によって所定のトルクを発生し、そのトルクを操舵機構に付加する。すると、操舵機構には、ドライバによる操舵トルクに応じたアシストトルクが加わるとともに、車両を車両中心に沿って走行させるための補助的な付加トルクが加わる。
The
図13には、カーブ半径が小さいあるいは高車速などによってフィードフォワード出力不足となり、車両の車線の外側にオフセットOF1が発生し、カーブ外側の積分値が増加した場合を示している。この場合、レーンキープ装置1では、車両がカーブ出口またはカーブ出口付近に到達したときに積分値をリセットするので、レーンキープの付加トルクには積分項に基づくカーブ内側方向のトルクが加味されない。したがって、車両の走行軌跡ML1はカーブ出口CCを過ぎた後も車線の中心線に沿った軌跡となり、車両のカーブ巻き込みは発生しない。 FIG. 13 shows a case where the feedforward output becomes insufficient due to a small curve radius or a high vehicle speed, the offset OF1 occurs outside the lane of the vehicle, and the integral value outside the curve increases. In this case, since the lane keeping device 1 resets the integrated value when the vehicle reaches the curve exit or the vicinity of the curve exit, the torque in the curve inward direction based on the integral term is not added to the additional torque of the lane keep. Therefore, the travel locus ML1 of the vehicle becomes a locus along the center line of the lane even after passing the curve exit CC, and the vehicle is not involved in the curve.
図14には、カーブ内側に低い路面カントの傾斜が大きく、車両に路面カントによるカーブ内側方向の大きな横加速度が作用し、車両の車線の内側にオフセットOF2が発生し、カーブ内側の積分値が増加した場合を示している。この場合、レーンキープ装置1では、車両がカーブ出口に到達したときに積分値をリセットするので、レーンキープの付加トルクには積分項に基づくカーブ外側方向のトルクが加味されない。したがって、車両の走行軌跡ML2はカーブ出口を過ぎた後も車線の中心線に沿った軌跡となり、車両の車線逸脱は発生しない。 In FIG. 14, the slope of the low road surface cant is large inside the curve, a large lateral acceleration in the direction of the curve due to the road surface cant acts on the vehicle, an offset OF2 is generated inside the vehicle lane, and the integral value inside the curve is The case where it increases is shown. In this case, since the lane keeping device 1 resets the integrated value when the vehicle reaches the curve exit, the additional torque of the lane keep does not include the torque in the curve outward direction based on the integral term. Therefore, the travel locus ML2 of the vehicle is a locus along the center line of the lane even after passing the curve exit, and the lane departure of the vehicle does not occur.
このレーンキープ装置1によれば、不要なオフセットの積分値をカーブ出口あるいはカーブ出口付近でリセットすることにより、レーンキープによる付加トルクに対して積分値に基づく不要なトルクが加味されない。そのため、レーンキープ装置1では、カーブ出口においてもレーンキープの適切な操舵トルクを付加することができ、車両を車線中心に沿って走行させる精度を向上させることができる。 According to the lane keeping device 1, by resetting the integral value of the unnecessary offset at the curve exit or in the vicinity of the curve exit, unnecessary torque based on the integral value is not added to the additional torque by the lane keep. Therefore, in the lane keeping device 1, it is possible to add an appropriate lane keeping steering torque even at the curve exit, and it is possible to improve the accuracy of traveling the vehicle along the lane center.
特に、レーンキープ装置1では、積分値をリセットするか否かを小Rカーブのカーブ出口とカーブ出口付近及び大Rカーブのカーブ出口で3つに切り分けて判断するので、リセットの必要性やリセットのタイミングを高精度に判断することができる。 In particular, the lane keeping device 1 determines whether or not to reset the integral value by dividing into three at the curve exit of the small R curve, the vicinity of the curve exit, and the curve exit of the large R curve. Can be determined with high accuracy.
小Rカーブのカーブ出口で判断する場合、レーンキープ装置1では、必ず積分項をリセットするので、急な傾斜の路面カントでも車線逸脱が発生することなく、小さいカーブ半径や高車速でもカーブ巻き込みが発生することはない。 When judging at the curve exit of a small R curve, the lane keep device 1 always resets the integral term, so even if the road surface cant steeply steep, lane departure does not occur, and even at a small curve radius and high vehicle speed, the curve is involved. It does not occur.
小Rカーブのカーブ出口付近で判断する場合、レーンキープ装置1では、積分値に基づく付加トルクが作用する方向とカーブの方向とが一致し、ドライバがカーブの方向に操舵していないときにのみ積分値のリセットのタイミングを早めるので、カーブ半径が小さくても、フィードフォワード出力不足によるカーブ巻き込みを招くことはない。この際、ドライバの操舵方向も考慮しているので、道路曲率γなどにCCDカメラ20(撮像画像)のノイズの影響がある場合でも、リセットのタイミングを高精度に判断することができる。 When judging near the curve exit of the small R curve, the lane keeping device 1 only when the direction in which the additional torque based on the integrated value acts and the direction of the curve match and the driver is not steering in the curve direction. Since the timing of resetting the integral value is advanced, even if the curve radius is small, there is no incursion of the curve due to insufficient feedforward output. At this time, since the steering direction of the driver is also taken into consideration, the reset timing can be determined with high accuracy even when the road curvature γ is influenced by noise of the CCD camera 20 (captured image).
大Rカーブのカーブ出口で判断する場合、レーンキープ装置1では、積分値に基づく付加トルクが作用する方向と車両の進行方向とが一致するときだけ積分値をリセットするので、車両が積分値に基づく付加トルクで更に進行方向側に押されるときだけ確実にリセットすることができ、必要性の高いリセットだけを行うことができる。 When determining at the curve exit of the large R curve, the lane keeping device 1 resets the integrated value only when the direction in which the additional torque based on the integrated value acts and the traveling direction of the vehicle coincide with each other. The reset can be surely performed only when it is pushed further in the traveling direction by the additional torque based on it, and only the reset with high necessity can be performed.
以上、本発明に係る実施の形態について説明したが、本発明は上記実施の形態に限定されることなく様々な形態で実施される。 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 this embodiment, the lane keep control is performed by adding torque to the steering mechanism. However, the lane keep control may be performed by another parameter that can change the steering state such as the steering angle. Good.
また、本実施の形態では一対の白線を認識することにより車線を検出する構成としたが、白線以外の黄線などの他の線も認識することにより車線を検出する構成としてもよいしあるいは路肩や車線と歩道とを区画するブロックなどを認識することにより車線を検出するなど他の方法により車線を検出する構成としてもよい。また、本実施の形態では車線がある道路に適用したが、車線がない道路に対しても適用可能である。この場合、その道路の路肩などを検出する必要がある。 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.
また、本実施の形態ではカメラによる撮像画像に基づいて車線(走行路)を認識し、その認識した車線に基づいてカーブ半径(道路曲率)、車両のヨー角、車両のオフセットを演算する構成としたが、他の手法によって走行路やこれらのパラメータを求めてもよく、例えば、ナビゲーションシステムでの処理や地図情報に基づいて検出する場合、各種センサを用いて検出する場合、路車間通信などを利用して車外から情報を取得する場合がある。 In the present embodiment, a lane (traveling road) is recognized based on an image captured by a camera, and a curve radius (road curvature), a vehicle yaw angle, and a vehicle offset are calculated based on the recognized lane. However, the road and these parameters may be obtained by other methods, for example, when detecting based on processing in the navigation system and map information, when detecting using various sensors, road-to-vehicle communication, etc. In some cases, information is obtained from outside the vehicle.
また、本実施の形態では車両の進行方向を車両のヨー角に基づいて判定する構成としたが、ナビゲーションシステムで求めた車両進行方向を取得するなどの他の方法によって車両の進行方向を検出してもよい。 In the present embodiment, the traveling direction of the vehicle is determined based on the yaw angle of the vehicle. However, the traveling direction of the vehicle is detected by other methods such as obtaining the traveling direction of the vehicle obtained by the navigation system. May be.
また、本実施の形態ではカーブ出口を道路曲率(カーブ半径)に基づいて判定する構成としたが、ナビゲーションシステムで求めた現在位置情報を取得するなどの他の方法によってカーブ出口を判定してもよい。 In the present embodiment, the curve exit is determined based on the road curvature (curve radius). However, the curve exit may be determined by other methods such as acquiring current position information obtained by the navigation system. Good.
また、本実施の形態では大Rカーブの出口での積分リセット制御、小Rカーブの出口での積分リセット制御、小Rカーブの出口付近での積分リセット制御を行う構成としたが、この3つの積分リセット制御のうちの1つの制御又は2つの制御だけを行う構成としてもよい。 In this embodiment, the integral reset control at the exit of the large R curve, the integral reset control at the exit of the small R curve, and the integral reset control near the exit of the small R curve are performed. It may be configured to perform only one control or two controls of the integral reset control.
また、本実施の形態では小Rカーブでの出口付近をドライバの操舵方向も用いて判断する構成としたが、撮像画像に基づいて求めた道路曲率などの情報の精度が高い場合には(カメラノイズの影響が少ない場合)、ドライバの操舵方向を用いないで判断してもよい。 In this embodiment, the vicinity of the exit at the small R curve is determined using the driver steering direction. However, when the accuracy of information such as road curvature obtained based on the captured image is high (camera If the influence of noise is small), the determination may be made without using the steering direction of the driver.
1…レーンキープ装置、2…ステアリングホイール、3…ステアリングシャフト、4…ステアリングギヤボックス、5…ラックバー、6…ナックルアーム、10…操舵トルクセンサ、11…車速センサ、20…CCDカメラ、21…画像処理部、30…ECU、31…F/Fコントローラ、32…積分器、33…目標横加速度演算器、34…出力トルク演算器、40…電動パワーステアリング装置、41…EPSECU、42…モータ DESCRIPTION OF SYMBOLS 1 ... Lane keeping device, 2 ... Steering wheel, 3 ... Steering shaft, 4 ... Steering gear box, 5 ... Rack bar, 6 ... Knuckle arm, 10 ... Steering torque sensor, 11 ... Vehicle speed sensor, 20 ... CCD camera, 21 ... Image processing unit, 30 ... ECU, 31 ... F / F controller, 32 ... integrator, 33 ... target lateral acceleration calculator, 34 ... output torque calculator, 40 ... electric power steering device, 41 ... EPSECU, 42 ... motor
Claims (7)
道路のカーブ半径を検出するカーブ半径検出手段と、
車両位置がカーブ路の出口か否かを判断するカーブ出口判断手段と、
車両の進行方向を検出する車両進行方向検出手段と
を備え、
前記カーブ半径検出手段で検出したカーブ半径が所定半径以上のカーブ路を走行中に前記カーブ出口判断手段で車両位置がカーブ路の出口と判断した場合、前記車両進行方向検出手段で検出した車両進行方向と積分項に基づく操舵制御方向とが一致するときに積分項をリセットすることを特徴とする操舵装置。 A travel path detecting means for detecting a travel path of the vehicle, a shift amount detecting means for detecting a shift amount from a predetermined position of the travel path of the vehicle, an integrating means for integrating the shift amount to obtain an integral term, And a calculation means for calculating a steering output for controlling the steering mechanism based on an amount of deviation from the predetermined position of the travel path and an integral term, and the steering mechanism so that the vehicle travels along the predetermined position of the travel path. In the steering device to be controlled,
A curve radius detecting means for detecting a curve radius of the road;
Curve exit judging means for judging whether or not the vehicle position is an exit of a curved road;
Vehicle traveling direction detection means for detecting the traveling direction of the vehicle,
When the vehicle exit is determined to be an exit of the curved road by the curve exit determining means while traveling on a curved road having a curve radius detected by the curve radius detecting means, the vehicle travel detected by the vehicle traveling direction detecting means. A steering device, wherein the integral term is reset when the direction and the steering control direction based on the integral term coincide.
道路のカーブ半径を検出するカーブ半径検出手段と、
車両位置がカーブ路の出口か否かを判断するカーブ出口判断手段と
を備え、
前記カーブ半径検出手段で検出したカーブ半径が所定半径以下のカーブ路を走行中に前記カーブ出口判断手段で車両位置がカーブ路の出口と判断した場合に積分項をリセットすることを特徴とする操舵装置。 A travel path detecting means for detecting a travel path of the vehicle, a shift amount detecting means for detecting a shift amount from a predetermined position of the travel path of the vehicle, an integrating means for integrating the shift amount to obtain an integral term, And a calculation means for calculating a steering output for controlling the steering mechanism based on an amount of deviation from the predetermined position of the travel path and an integral term, and the steering mechanism so that the vehicle travels along the predetermined position of the travel path. In the steering device to be controlled,
A curve radius detecting means for detecting a curve radius of the road;
A curve exit judging means for judging whether the vehicle position is an exit of a curved road,
Steering characterized in that the integral term is reset when the curve exit determining means determines that the vehicle position is the exit of the curve road while traveling on a curved road having a curve radius detected by the curve radius detecting means or less. apparatus.
道路のカーブ半径を検出するカーブ半径検出手段と、
カーブ路の曲がる方向を検出するカーブ方向検出手段と
を備え、
前記カーブ半径検出手段で検出したカーブ半径が所定半径以下のカーブ路を走行中に前記カーブ方向検出手段で検出したカーブ路の曲がる方向と積分項に基づく操舵制御方向とが一致した場合に積分項をリセットするタイミングをカーブ路の出口に基づくタイミングより早めることを特徴とする操舵装置。 A travel path detecting means for detecting a travel path of the vehicle, a shift amount detecting means for detecting a shift amount from a predetermined position of the travel path of the vehicle, an integrating means for integrating the shift amount to obtain an integral term, And a calculation means for calculating a steering output for controlling the steering mechanism based on an amount of deviation from the predetermined position of the travel path and an integral term, and the steering mechanism so that the vehicle travels along the predetermined position of the travel path. In the steering device to be controlled,
A curve radius detecting means for detecting a curve radius of the road;
And a curve direction detecting means for detecting a direction in which a curved road is bent,
When the curve radius detected by the curve direction detection means coincides with the steering control direction based on the integral term while traveling on a curved road whose curve radius detected by the curve radius detection means is a predetermined radius or less, the integral term A steering device characterized in that the timing for resetting the vehicle is earlier than the timing based on the exit of the curved road.
前記操舵方向検出手段で検出したドライバによる操舵方向と前記カーブ方向検出手段で検出したカーブ路の曲がる方向とが異なる場合に積分項をリセットするタイミングを早めることを特徴とする請求項5に記載する操舵装置。 A steering direction detection means for detecting the steering direction by the driver;
6. The timing for resetting an integral term is advanced when a steering direction by a driver detected by the steering direction detection unit is different from a turning direction of a curved road detected by the curve direction detection unit. Steering device.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005344114A JP4951947B2 (en) | 2005-11-29 | 2005-11-29 | Steering device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005344114A JP4951947B2 (en) | 2005-11-29 | 2005-11-29 | Steering device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007145227A true JP2007145227A (en) | 2007-06-14 |
JP4951947B2 JP4951947B2 (en) | 2012-06-13 |
Family
ID=38207138
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005344114A Expired - Fee Related JP4951947B2 (en) | 2005-11-29 | 2005-11-29 | Steering device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4951947B2 (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014024414A (en) * | 2012-07-25 | 2014-02-06 | Fuji Heavy Ind Ltd | Vehicular power steering control unit |
JP2016175571A (en) * | 2015-03-20 | 2016-10-06 | 富士重工業株式会社 | Traffic lane deviation prevention control device for vehicle |
JP2016199196A (en) * | 2015-04-14 | 2016-12-01 | 株式会社日本自動車部品総合研究所 | Traveling route estimation device |
US20180281849A1 (en) * | 2017-03-31 | 2018-10-04 | Toyota Jidosha Kabushiki Kaisha | Steering control apparatus |
JP2019119278A (en) * | 2017-12-28 | 2019-07-22 | 株式会社Subaru | Lane departure prevention control device for vehicle |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000127931A (en) * | 1998-10-28 | 2000-05-09 | Honda Motor Co Ltd | Vehicle control device |
JP2002120744A (en) * | 2000-10-18 | 2002-04-23 | Nissan Motor Co Ltd | Lane keep assist control device |
JP2005170152A (en) * | 2003-12-09 | 2005-06-30 | Nissan Motor Co Ltd | Deceleration control device |
-
2005
- 2005-11-29 JP JP2005344114A patent/JP4951947B2/en not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000127931A (en) * | 1998-10-28 | 2000-05-09 | Honda Motor Co Ltd | Vehicle control device |
JP2002120744A (en) * | 2000-10-18 | 2002-04-23 | Nissan Motor Co Ltd | Lane keep assist control device |
JP2005170152A (en) * | 2003-12-09 | 2005-06-30 | Nissan Motor Co Ltd | Deceleration control device |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014024414A (en) * | 2012-07-25 | 2014-02-06 | Fuji Heavy Ind Ltd | Vehicular power steering control unit |
JP2016175571A (en) * | 2015-03-20 | 2016-10-06 | 富士重工業株式会社 | Traffic lane deviation prevention control device for vehicle |
JP2016199196A (en) * | 2015-04-14 | 2016-12-01 | 株式会社日本自動車部品総合研究所 | Traveling route estimation device |
US20180281849A1 (en) * | 2017-03-31 | 2018-10-04 | Toyota Jidosha Kabushiki Kaisha | Steering control apparatus |
US11027777B2 (en) * | 2017-03-31 | 2021-06-08 | Toyota Jidosha Kabushiki Kaisha | Steering control apparatus |
US20210253164A1 (en) * | 2017-03-31 | 2021-08-19 | Toyota Jidosha Kabushiki Kaisha | Steering control apparatus |
US11794807B2 (en) * | 2017-03-31 | 2023-10-24 | Toyota Jidosha Kabushiki Kaisha | Steering control apparatus |
JP2019119278A (en) * | 2017-12-28 | 2019-07-22 | 株式会社Subaru | Lane departure prevention control device for vehicle |
US10647349B2 (en) | 2017-12-28 | 2020-05-12 | Subaru Corporation | Lane deviation prevention control device for vehicle |
Also Published As
Publication number | Publication date |
---|---|
JP4951947B2 (en) | 2012-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1275573B1 (en) | Lane-keep control system for vehicle | |
JP3690283B2 (en) | Lane tracking control device | |
JP5055933B2 (en) | Driving support device | |
JP5109296B2 (en) | Driving support device | |
US10479358B2 (en) | In-lane driving assist apparatus for a vehicle | |
EP1170195B1 (en) | Lane following vehicle control | |
US8352124B2 (en) | Steering control device | |
JP4923567B2 (en) | Steering device | |
JP5195079B2 (en) | Driving assistance device | |
EP1602558A2 (en) | Steering assist apparatus and method for vehicle | |
JP5853552B2 (en) | Vehicle travel control device | |
EP1742124A1 (en) | Servo controller comprising two integrators for reducing phase delay | |
JP4951947B2 (en) | Steering device | |
JP7348775B2 (en) | Vehicle lane departure prevention control device | |
JP3800087B2 (en) | Lane departure prevention device | |
JP2007168592A (en) | Road inclination detection device | |
JP2005014738A (en) | Vehicular travel support device | |
JP3738709B2 (en) | Lane departure warning device | |
JP4175293B2 (en) | Vehicle steering assist device | |
JP4923565B2 (en) | Steering device | |
JP6317972B2 (en) | Vehicle lane departure prevention control device | |
JP4333484B2 (en) | Road parameter calculation device and vehicle behavior control device | |
JP2007191156A (en) | Travel supporting device for vehicle | |
JP2007015545A (en) | Steering gear | |
JP4923564B2 (en) | Steering device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20081103 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110322 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110712 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110825 |
|
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: 20120214 |
|
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: 20120227 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 4951947 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: 20150323 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |