JP2014210456A - Steering control device for vehicle - Google Patents

Steering control device for vehicle Download PDF

Info

Publication number
JP2014210456A
JP2014210456A JP2013086610A JP2013086610A JP2014210456A JP 2014210456 A JP2014210456 A JP 2014210456A JP 2013086610 A JP2013086610 A JP 2013086610A JP 2013086610 A JP2013086610 A JP 2013086610A JP 2014210456 A JP2014210456 A JP 2014210456A
Authority
JP
Japan
Prior art keywords
vehicle
distance
lane marks
right lane
target
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.)
Pending
Application number
JP2013086610A
Other languages
Japanese (ja)
Inventor
伊藤 誠
Makoto Ito
伊藤  誠
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.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co Ltd
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 Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to JP2013086610A priority Critical patent/JP2014210456A/en
Publication of JP2014210456A publication Critical patent/JP2014210456A/en
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits

Abstract

PROBLEM TO BE SOLVED: To provide a steering control device for a vehicle that can prevent steering control from being performed against the intention of a driver in a condition, such as a branch passage, where an interval between right and left lane marks increases with the increasing distance from the vehicle when steering of the vehicle is controlled based on the right and left lane marks.SOLUTION: A control device 10 includes: a recognition section 12 for recognizing right and left lane marks of a road on which a vehicle 1 is traveling on the basis of an image taken by a camera 20 for imaging the traveling direction of the vehicle 1; a determination section 13 for determining a target traveling position P on the basis of the recognized positions of the right and left lane marks; and a steering control section 14 for controlling steering of the vehicle 1 in accordance with the determined target traveling position P. The determination section 13 determines the target traveling position P to suppress a change in the target traveling position P in accordance with a change in an interval between the right and left lane marks when the interval increases with the increasing distance from the vehicle 1.

Description

本発明は、車両の操舵を制御する操舵制御装置に関する。   The present invention relates to a steering control device that controls steering of a vehicle.

従来、車両の前方の撮像画像に基づいて、この車両が走行している道路における左右の車線及び道路鋲等のレーンマークの配置を認識し、左右のレーンマークにより左右が確定される走行領域から外れずに車両が走行するように(例えば、走行領域の中心ラインに従って車両が走行するように)、当該車両の操舵を制御する操舵制御装置が提案されている(例えば、特許文献1参照)。   Conventionally, based on a captured image in front of the vehicle, the arrangement of lane marks such as left and right lanes and roadsides on the road on which the vehicle is traveling is recognized, and the left and right lane marks are used to determine the left and right lane marks. A steering control device that controls the steering of the vehicle has been proposed so that the vehicle travels without detachment (for example, the vehicle travels according to the center line of the travel region) (see, for example, Patent Document 1).

分岐路のように左右のレーンマークの各々が、分岐後において異なる道路に連続している場合には、車両が走行している道路の左右のレーンマーク間の距離が車両から離れるにつれて大きくなる。このため、この操舵制御装置では、分岐路であると判定された場合には、左右のレーンマークのうち車両の進行方向に沿って伸びているレーンマーク(すなわち、片方のレーンマーク)のみに基づいて、車両の操舵を制御している。   When each of the left and right lane marks continues to different roads after branching as in a branch road, the distance between the left and right lane marks on the road on which the vehicle is traveling increases as the distance from the vehicle increases. For this reason, in this steering control device, when it is determined that the road is a branch road, it is based on only the lane mark (that is, one lane mark) extending along the traveling direction of the vehicle among the left and right lane marks. The steering of the vehicle is controlled.

特開2009−214786号公報JP 2009-214786 A

しかしながら、車両が分岐路に接近している状況下においては、分岐路であると判定するまでの間に、左右のレーンマーク間の距離が徐々に広がることにより、当該距離の変化に応じて走行領域の中心ラインが分岐路の方に向かうように変化する。これにより、運転者の意に反して、車両が分岐路の方に向かうように当該車両の操舵が制御されてしまう。   However, when the vehicle is approaching a branch road, the distance between the left and right lane marks gradually increases until the vehicle is determined to be a branch road, so that the vehicle travels according to the change in the distance. The center line of the area changes so as to go to the branch road. Thereby, contrary to a driver | operator's will, the steering of the said vehicle will be controlled so that a vehicle heads toward a branch road.

本発明は、以上の点に鑑みてなされたものであり、左右のレーンマークに基づいて車両の操舵を制御する場合に、分岐路等のように左右のレーンマーク間の距離が車両から離れるにつれて大きくなる条件下で、運転者の意に反した操舵制御がなされることを防止できる車両の操舵制御装置を提供することを目的とする。   The present invention has been made in view of the above points, and when controlling the steering of a vehicle based on left and right lane marks, as the distance between the left and right lane marks increases away from the vehicle, such as a branch road. It is an object of the present invention to provide a vehicle steering control device that can prevent steering control against the intention of the driver under increasing conditions.

本発明は、車両の進行方向を撮像するカメラによる撮像画像に基づいて、前記車両が走行している道路の左右のレーンマークを認識するように構成された認識部と、前記認識部によって認識された左右のレーンマークの位置に基づいて、前記車両の操舵制御の目標とする目標パラメータを決定するように構成された決定部と、前記決定部によって決定された目標パラメータに従って、前記車両の操舵を制御するように構成された操舵制御部とを備える車両の操舵制御装置であって、前記決定部は、前記認識部によって認識された左右のレーンマーク間の距離が、前記車両から離れるにつれて長くなるときに、前記距離の変化に応じた前記目標パラメータの変化を抑制するように、前記目標パラメータを補正することを特徴とする。   The present invention recognizes a recognition unit configured to recognize left and right lane marks of a road on which the vehicle is traveling, based on a captured image captured by a camera that captures the traveling direction of the vehicle, and the recognition unit. And determining a target parameter to be a target for steering control of the vehicle based on the positions of the left and right lane marks, and steering the vehicle according to the target parameter determined by the determination unit. A steering control device for a vehicle including a steering control unit configured to control, wherein the determination unit increases a distance between left and right lane marks recognized by the recognition unit as the distance from the vehicle increases. Sometimes, the target parameter is corrected so as to suppress the change of the target parameter according to the change of the distance.

本発明によれば、左右のレーンマーク間の距離の変化に応じた目標パラメータの変化を抑制するように決定部によって決定された目標パラメータに従って、操舵制御部が車両の操舵を制御する。従って、左右のレーンマークに基づいて車両の操舵を制御する場合に、分岐路等のように左右のレーンマーク間の距離が車両から離れるにつれて大きくなる条件下で、当該距離の変化に応じて目標パラメータが分岐路の方に向かうように変化することが防止される。そのため、運転者の意に反した操舵制御がなされることを防止できる。   According to the present invention, the steering control unit controls the steering of the vehicle according to the target parameter determined by the determination unit so as to suppress the change of the target parameter according to the change of the distance between the left and right lane marks. Therefore, when the steering of the vehicle is controlled based on the left and right lane marks, the target according to the change in the distance is obtained under the condition that the distance between the left and right lane marks increases as the distance from the vehicle increases. The parameter is prevented from changing toward the branch path. For this reason, it is possible to prevent the steering control against the intention of the driver.

本発明において、前記決定部は、前記認識部によって認識された左右のレーンマーク間の中点を通る基準線を設定し、所定時間が経過した後に、該基準線に前記車両が位置するように、前記車両の目標位置とする目標走行位置を前記目標パラメータとして決定し、前記認識部によって認識された左右のレーンマークのうちいずれか一方の曲率が大きくなることで、該左右のレーンマーク間の距離が前記車両から離れるにつれて長くなるときには、前記所定時間内における前記左右のレーンマーク間の距離の変化の半分の長さを算出し、前記補正として、前記目標走行位置を、前記左右のレーンマーク間の距離方向において、前記基準線から前記左右のレーンマークのうち曲率が大きくなっていない方のレーンマークの方に、前記算出された長さ分ずらす処理を行うことが好ましい。   In the present invention, the determination unit sets a reference line passing through a midpoint between the left and right lane marks recognized by the recognition unit, and the vehicle is positioned on the reference line after a predetermined time has elapsed. The target travel position as the target position of the vehicle is determined as the target parameter, and the curvature of one of the left and right lane marks recognized by the recognition unit is increased, so that the distance between the left and right lane marks is increased. When the distance increases as the distance from the vehicle increases, a half length of a change in the distance between the left and right lane marks within the predetermined time is calculated, and the target travel position is determined as the correction by using the target travel position as the left and right lane marks. In the distance direction between, the calculated length from the reference line toward the lane mark having the smallest curvature among the left and right lane marks. It is preferable to perform the shifting minute treatment.

左右のレーンマークのうちいずれか一方の曲率が大きくなることで、基準線は、左右のレーンマーク間の距離方向において、所定時間内において左右のレーンマーク間の距離の変化部の半分の長さだけ位置が移動する。従って、基準線から左右のレーンマークのうち曲率が大きくなっていない方のレーンマークの方に、該算出された長さ分ずらすように目標走行位置を決定することで、所定時間内における左右のレーンマーク間の距離が変化していないと仮定したときの目標走行位置を得ることができる。これにより、左右のレーンマーク間の距離の変化に応じて車両が分岐路の方に向かうように変化することを防止できる。   By increasing the curvature of one of the left and right lane marks, the reference line is half the length of the change in the distance between the left and right lane marks within a predetermined time in the distance direction between the left and right lane marks. Only move the position. Therefore, by determining the target travel position so that the calculated lane mark is shifted by the calculated lane mark to the lane mark whose curvature is not large among the left and right lane marks from the reference line, the left and right lane marks within a predetermined time are determined. It is possible to obtain the target travel position when it is assumed that the distance between the lane marks has not changed. Accordingly, it is possible to prevent the vehicle from changing toward the branch road according to a change in the distance between the left and right lane marks.

本発明において、前記決定部は、前記認識部によって認識された左右のレーンマーク間の中点を通る基準線を設定し、該基準線に前記車両が位置するように、前記基準線の曲率に基づいて、前記車両の操舵を制御するトルクの目標とする目標トルクを前記目標パラメータとして決定し、前記左右のレーンマーク間の距離が前記車両から離れるにつれて長くなるときには、前記補正として、所定時間内における前記距離の変化と、前記車両の移動量とに基づいて、前記距離の変化に応じた前記目標トルクの変化を抑制するように前記基準線の曲率を補正して、該補正された曲率に基づいて前記目標トルクを決定する処理を行うことが好ましい。   In the present invention, the determination unit sets a reference line that passes through a midpoint between the left and right lane marks recognized by the recognition unit, and adjusts the curvature of the reference line so that the vehicle is positioned on the reference line. A target torque that is a target of torque for controlling steering of the vehicle is determined as the target parameter, and when the distance between the left and right lane marks increases as the distance from the vehicle increases, the correction is performed within a predetermined time. Based on the change in the distance and the amount of movement of the vehicle, the curvature of the reference line is corrected so as to suppress the change in the target torque according to the change in the distance, and the corrected curvature is obtained. It is preferable to perform a process of determining the target torque based on the above.

この構成によれば、目標トルクは、左右のレーンマーク間の距離の変化に応じて変化することが抑制される。従って、左右のレーンマークに基づいて車両の操舵を制御する場合に、分岐路等のように左右のレーンマーク間の距離が車両から離れるにつれて大きくなる条件下で、当該距離の変化に応じて目標トルクが分岐路の方に向かうように変化することを防止できる。   According to this configuration, the target torque is suppressed from changing according to a change in the distance between the left and right lane marks. Therefore, when the steering of the vehicle is controlled based on the left and right lane marks, the target according to the change in the distance is obtained under the condition that the distance between the left and right lane marks increases as the distance from the vehicle increases. It is possible to prevent the torque from changing toward the branch path.

本発明において、前記決定部は、前記認識部によって認識された左右のレーンマーク間の中点を通る基準線を設定し、該基準線に前記車両が位置するように、該基準線に対する前記車両の横ずれ量に基づいて、前記車両の操舵を制御するトルクの目標とする目標トルクを前記目標パラメータとして決定し、前記認識部によって認識された左右のレーンマークのうちいずれか一方の曲率が大きくなることで、該左右のレーンマーク間の距離が前記車両から離れるにつれて長くなるときには、前記補正として、所定時間内における前記左右のレーンマーク間の距離の変化の半分の長さを算出し、前記基準線に対する前記車両の横ずれ量と、該算出された前記長さとの差を、前記車両の横ずれ量に置き換えて前記目標トルクを決定する処理を行うことが好ましい。   In the present invention, the determination unit sets a reference line that passes through a midpoint between the left and right lane marks recognized by the recognition unit, and the vehicle with respect to the reference line is positioned at the reference line. Based on the lateral deviation amount, a target torque that is a target of the torque for controlling the steering of the vehicle is determined as the target parameter, and the curvature of one of the left and right lane marks recognized by the recognition unit increases. Thus, when the distance between the left and right lane marks becomes longer as the distance from the vehicle increases, as the correction, a half length of a change in the distance between the left and right lane marks within a predetermined time is calculated, and the reference A process of determining the target torque by replacing a difference between the lateral displacement amount of the vehicle with respect to the line and the calculated length with the lateral displacement amount of the vehicle. It is preferred.

左右のレーンマークのうちいずれか一方の曲率が大きくなることで、基準線は、左右のレーンマーク間の距離方向において、所定時間内において左右のレーンマーク間の距離の変化の半分の長さだけ位置が移動する。従って、基準線に対する車両の横ずれ量と該算出された長さとの差は、所定時間内における左右のレーンマーク間の距離が変化していないと仮定したときの車両の横ずれ量を表す。このような差に基づくことで、左右のレーンマーク間の距離の変化に応じて車両が分岐路の方に向かうように変化することを防止できるような目標トルクを決定できる。   By increasing the curvature of one of the left and right lane marks, the reference line is only half the length of the change in the distance between the left and right lane marks within a predetermined time in the distance direction between the left and right lane marks. The position moves. Therefore, the difference between the lateral displacement amount of the vehicle with respect to the reference line and the calculated length represents the lateral displacement amount of the vehicle when it is assumed that the distance between the left and right lane marks has not changed within a predetermined time. Based on such a difference, it is possible to determine a target torque that can prevent the vehicle from changing toward the branch road according to a change in the distance between the left and right lane marks.

本発明において、前記決定部は、前記認識部によって認識された左右のレーンマーク間の中点を通る基準線を設定し、該基準線に前記車両が位置するように、該基準線に対する前記車両の偏向角に基づいて、前記車両の操舵を制御するトルクの目標とする目標トルクを前記目標パラメータとして決定し、前記左右のレーンマーク間の距離が前記車両から離れるにつれて長くなるときには、前記補正として、所定時間内における前記距離の変化と前記車両の移動量とに基づいて、前記距離の変化に応じた前記基準線に対する前記車両の偏向角の拡大を許容して、前記車両の進行方向の変化を抑制する処理を行うことが好ましい。   In the present invention, the determination unit sets a reference line that passes through a midpoint between the left and right lane marks recognized by the recognition unit, and the vehicle with respect to the reference line is positioned at the reference line. Based on the deflection angle, a target torque that is a target of torque for controlling steering of the vehicle is determined as the target parameter, and when the distance between the left and right lane marks becomes longer as the distance from the vehicle increases, the correction is performed. Based on the change in the distance and the amount of movement of the vehicle within a predetermined time, the deflection direction of the vehicle is allowed to increase with respect to the reference line according to the change in the distance, and the change in the traveling direction of the vehicle It is preferable to perform a process of suppressing the above.

この構成によれば、距離の変化に応じた基準線に対する車両の偏向角の拡大が許容されるので、距離の変化に応じて車両の進行方向が変化することを抑制するような目標トルクが決定される。従って、左右のレーンマークに基づいて車両の操舵を制御する場合に、分岐路等のように左右のレーンマーク間の距離が車両から離れるにつれて大きくなる条件下で、当該距離の変化に応じて目標トルクが分岐路の方に向かうように変化することを防止できる。   According to this configuration, since the deflection angle of the vehicle with respect to the reference line corresponding to the change in the distance is allowed to be increased, a target torque that suppresses the change in the traveling direction of the vehicle according to the change in the distance is determined. Is done. Therefore, when the steering of the vehicle is controlled based on the left and right lane marks, the target according to the change in the distance is obtained under the condition that the distance between the left and right lane marks increases as the distance from the vehicle increases. It is possible to prevent the torque from changing toward the branch path.

車両の操舵制御装置の使用態様の説明図。Explanatory drawing of the usage condition of the steering control apparatus of a vehicle. 車両の操舵制御装置の構成図。The block diagram of the steering control apparatus of a vehicle. 車両の操舵制御装置の作動フローチャート。The operation | movement flowchart of the steering control apparatus of a vehicle. カメラで撮像した画像を示す図。The figure which shows the image imaged with the camera. 走行路が抽出された上方視画像における目標走行位置の補正について説明する図。The figure explaining correction | amendment of the target driving | running | working position in the upper view image from which the driving | running route was extracted. 車両の操舵制御装置の別の態様において曲率の補正について説明する図。The figure explaining correction | amendment of a curvature in another aspect of the steering control apparatus of a vehicle. 車両の操舵制御装置の別の態様において偏向角の補正について説明する図。The figure explaining correction | amendment of a deflection angle in another aspect of the steering control apparatus of a vehicle.

以下、本発明の車両の操舵制御装置の実施形態について説明する。図1を参照して、本実施形態の車両の操舵制御装置(以下、単に「制御装置」という)10は、車両1(自車両)に搭載して使用される。制御装置10は、車両1に搭載されたカメラ20の撮像画像から車両1の進行方向の(本実施形態においては、前方)道路の状況を認識して、車両1の走行状態を制御する。   Hereinafter, an embodiment of a steering control device for a vehicle according to the present invention will be described. Referring to FIG. 1, a vehicle steering control device (hereinafter simply referred to as “control device”) 10 of the present embodiment is mounted and used in a vehicle 1 (own vehicle). The control device 10 recognizes the state of the road in the traveling direction of the vehicle 1 (forward in the present embodiment) from the captured image of the camera 20 mounted on the vehicle 1 and controls the traveling state of the vehicle 1.

カメラ20は、車両1の前方をフロントウィンドウ越しに撮像するように、光軸を車両1の前後方向に合わせて車内に取り付けられている。なお、カメラ20の取付部を原点として、車両1の左右方向(車幅方向)をY軸、上下方向(鉛直方向)をX軸、前後方向(進行方向)をZ軸とした実空間座標系が定義されている。   The camera 20 is mounted in the vehicle with its optical axis aligned with the front-rear direction of the vehicle 1 so as to capture the front of the vehicle 1 through the front window. A real space coordinate system in which the mounting portion of the camera 20 is the origin, the left-right direction (vehicle width direction) of the vehicle 1 is the Y axis, the vertical direction (vertical direction) is the X axis, and the front-rear direction (traveling direction) is the Z axis. Is defined.

また、車両1は、当該車両1の操舵を行う操舵装置30を備えている。制御装置10は、操舵装置30を制御することで、車両1の操舵を制御している。   The vehicle 1 also includes a steering device 30 that steers the vehicle 1. The control device 10 controls the steering of the vehicle 1 by controlling the steering device 30.

次に、図2を参照して、車両1は、速度センサ21、加速度センサ22、ヨーレートセンサ23、及び制動装置31を備えている。速度センサ21は車両1の速度の検出信号を出力し、加速度センサ22は車両1の加速度の検出信号を出力し、ヨーレートセンサ23は車両1のヨーレートの検出信号を出力する。   Next, referring to FIG. 2, the vehicle 1 includes a speed sensor 21, an acceleration sensor 22, a yaw rate sensor 23, and a braking device 31. The speed sensor 21 outputs a detection signal for the speed of the vehicle 1, the acceleration sensor 22 outputs a detection signal for the acceleration of the vehicle 1, and the yaw rate sensor 23 outputs a detection signal for the yaw rate of the vehicle 1.

制御装置10は、CPU及びメモリ等により構成された電子ユニットであり、カメラ20の映像信号及び各センサ21,22,23の検出信号が入力される。制御装置10は、これらの入力によって、車両1の走行状態を認識する。   The control device 10 is an electronic unit including a CPU, a memory, and the like, and receives a video signal of the camera 20 and detection signals of the sensors 21, 22, and 23. The control device 10 recognizes the traveling state of the vehicle 1 based on these inputs.

また、制御装置10は、メモリに保持された車両1の制御用プログラムをCPUで実行することによって、撮像画像取得部11、認識部12、決定部13、及び操舵制御部14として機能する。   Further, the control device 10 functions as the captured image acquisition unit 11, the recognition unit 12, the determination unit 13, and the steering control unit 14 by executing a control program for the vehicle 1 held in the memory by the CPU.

認識部12は、撮像画像取得部11によって取得されたカメラ20の撮像画像に基づいて、車両1が走行している道路の左右のレーンマークを認識する。そして、決定部13は、該認識された左右のレーンマークの位置に基づいて、車両1の走行位置の目標位置となる目標走行位置P(本発明の目標パラメータに相当する)を決定する。このとき、決定部13は、左右のレーンマーク間の距離が車両1から離れるにつれて大きくなるときに、この距離の変化に応じた目標走行位置Pの変化を抑制するように目標走行位置Pを決定する。そして、操舵制御部14は、車両1の操舵が該決定された目標走行位置Pに従った操舵となるように、操舵装置30と制動装置31の一方又は両方を作動させて、車両の走行状態を制御する。   The recognition unit 12 recognizes the left and right lane marks of the road on which the vehicle 1 is traveling based on the captured image of the camera 20 acquired by the captured image acquisition unit 11. Then, the determination unit 13 determines a target travel position P (corresponding to the target parameter of the present invention) that is the target position of the travel position of the vehicle 1 based on the recognized positions of the left and right lane marks. At this time, when the distance between the left and right lane marks increases as the distance from the vehicle 1 increases, the determination unit 13 determines the target travel position P so as to suppress the change in the target travel position P according to the change in the distance. To do. Then, the steering control unit 14 operates one or both of the steering device 30 and the braking device 31 so that the steering of the vehicle 1 is steered according to the determined target traveling position P, and the traveling state of the vehicle To control.

これにより、左右のレーンマークに基づいて車両1の操舵を制御する場合に、分岐路等のように左右のレーンマーク間の距離が車両から離れるにつれて大きくなる条件下で、当該距離の変化に応じて目標走行位置Pが分岐路の方に向かうように変化することが防止される。そのため、運転者の意に反した操舵制御がなされることを防止できる。   As a result, when the steering of the vehicle 1 is controlled based on the left and right lane marks, the distance between the left and right lane marks increases as the distance from the vehicle increases, such as a branch road. Thus, the target travel position P is prevented from changing toward the branch road. For this reason, it is possible to prevent the steering control against the intention of the driver.

以降の説明では、車両1が、進行方向の先に分岐路がある道路(左右のレーンマークのうちいずれか一方の曲率が大きくなることで、該左右のレーンマーク間の距離が車両1から離れるにつれて大きくなる道路)を走行している状況を例に説明する。   In the following description, the vehicle 1 is a road having a branch road ahead in the traveling direction (the curvature between one of the left and right lane marks is increased, so that the distance between the left and right lane marks is separated from the vehicle 1. As an example, a situation where the vehicle is traveling on a road that increases as the vehicle travels will be described.

制御装置10は、所定の制御周期(例えば、10 msec)毎に図3のフローチャートによる処理を実行して、車両1の走行状態を制御する。   The control device 10 controls the running state of the vehicle 1 by executing the process according to the flowchart of FIG. 3 every predetermined control period (for example, 10 msec).

図3の最初のステップST1において、制御装置10は、カメラ20から出力される映像信号を入力してデジタル信号に変換し、カメラ20の撮像画像(グレースケール画像)として画像メモリに保持する。これにより、例えば、図4に示されているように、車両1の進行方向の先に分岐路がある道路が写った撮像画像が取得される。ステップST1は、撮像画像取得部11により実行される処理である。   In the first step ST1 of FIG. 3, the control device 10 receives the video signal output from the camera 20, converts it into a digital signal, and holds it in the image memory as a captured image (grayscale image) of the camera 20. Thereby, for example, as shown in FIG. 4, a captured image in which a road having a branch road ahead of the traveling direction of the vehicle 1 is captured is acquired. Step ST <b> 1 is a process executed by the captured image acquisition unit 11.

次のステップST2では、制御装置10は、ステップST1で取得した撮像画像に基づいて、レーンマークを認識する。詳細には、制御装置10は、カメラ20の撮像画像を2値化してエッジ抽出処理を行った後、射影変換して上方視画像を取得する。   In the next step ST2, the control device 10 recognizes the lane mark based on the captured image acquired in step ST1. Specifically, the control device 10 binarizes the captured image of the camera 20 and performs edge extraction processing, and then performs projective conversion to obtain an upper-view image.

そして、制御装置10は、該取得した上方視画像に基づいて(輝度の変化等を検知して)レーンマークのエッジ線を抽出することで、車両1の左側及び右側の各々に配置されているレーンマークを、左側レーンマーク及び右側レーンマークの各々として認識する。そして、制御装置10は、各レーンマークのエッジ線において、所定の間隔で複数の点をサンプリングすることでエッジ点(図5に示される左右のレーンマークの黒点)を抽出する。   And the control apparatus 10 is arrange | positioned at each of the left side and the right side of the vehicle 1 by extracting the edge line of a lane mark (detecting the change of a brightness | luminance etc.) based on this acquired upward view image. The lane mark is recognized as each of the left lane mark and the right lane mark. And the control apparatus 10 extracts an edge point (black point of the right and left lane mark shown by FIG. 5) by sampling a some point in predetermined intervals in the edge line of each lane mark.

ボッツドッツや車線(白線)等のレーンマークは、特開2006−309499号公報又は特開2006−331193号公報等に開示されている画像処理方法にしたがって認識される。   Lane marks such as botsdots and lanes (white lines) are recognized according to an image processing method disclosed in Japanese Unexamined Patent Application Publication No. 2006-309499 or Japanese Unexamined Patent Application Publication No. 2006-331193.

ステップST2は、認識部12により実行される処理である。   Step ST2 is a process executed by the recognition unit 12.

次のステップST3では、制御装置10は、ステップST2で認識されたレーンマークに基づいて基準線M1を決定する。詳細には、制御装置10は、前記認識されたレーンマークから走行可能領域(左右のレーンマークによって左右が画定される領域)を平面的に認識し、更に、その走行可能領域上に、予め定められた規則(例えば、走行可能領域の中心又は中心から僅かにずらして設定する等)に従って、基準線M1を決定している。本実施形態においては、制御装置10は、走行可能領域の中心を通る線(左右のレーンマーク間の中点を通る線)を基準線M1として決定している。   In the next step ST3, the control device 10 determines the reference line M1 based on the lane mark recognized in step ST2. Specifically, the control device 10 planarly recognizes a travelable region (a region defined by the left and right lane marks) from the recognized lane mark, and further determines in advance on the travelable region. The reference line M1 is determined in accordance with a given rule (for example, setting the center of the travelable region or being slightly shifted from the center). In the present embodiment, the control device 10 determines a line passing through the center of the travelable area (a line passing through the midpoint between the left and right lane marks) as the reference line M1.

そして、制御装置10は、基準線M1上において、所定時間T経過後の車両1の目標となる位置(目標走行位置)Pを決定する。   And the control apparatus 10 determines the position (target driving position) P used as the target of the vehicle 1 after predetermined time T progress on the reference line M1.

次のステップST4では、制御装置10は、車両1の前方の車線の幅が広がっているか否かを判定する(換言すると、ステップST2で認識された左右のレーンマーク間の距離が、車両から離れるにつれて大きくなるか否かを判定する)。   In the next step ST4, the control device 10 determines whether or not the width of the lane ahead of the vehicle 1 is widened (in other words, the distance between the left and right lane marks recognized in step ST2 is separated from the vehicle). To determine if it grows as you).

制御装置10は、ステップST4で、車両1の前方の車線の幅が広がっていないと判定した場合には、車両1の走行状況が、「直線の道路」、「カーブ路の入口手前の道路」、「下り坂」又は「幅が狭くなる道路」等を走行している状況であると推定される。   When it is determined in step ST4 that the width of the lane ahead of the vehicle 1 is not widened, the control device 10 determines that the traveling state of the vehicle 1 is “straight road”, “road just before the entrance to the curve road”. It is estimated that the vehicle is traveling on a “downhill” or “road narrowing”.

この場合には、制御装置10は、ステップST5〜ST8の処理(車両1の前方の車線の幅が広がっている場合の処理)を行わずにステップST9に進み、ステップST3で決定された目標走行位置Pに従って車両1の操舵を制御する。   In this case, the control device 10 proceeds to step ST9 without performing the processing of steps ST5 to ST8 (processing when the width of the lane ahead of the vehicle 1 is widened), and the target travel determined in step ST3. The steering of the vehicle 1 is controlled according to the position P.

制御装置10は、ステップST4で、車両1の前方の車線の幅が広がっていると判定した場合には、車両1の走行状況が、「カーブ路」、「上り坂」、「分岐路の手前の道路」又は「幅が広くなる道路」等を走行している状況であると推定される。   When the control device 10 determines in step ST4 that the width of the lane ahead of the vehicle 1 is wide, the traveling state of the vehicle 1 is “curved road”, “uphill”, “before the branch road”. It is presumed that the vehicle is traveling on a “road of road” or a “road road”.

この場合には、制御装置10は、ステップST5に進み、基準線M1のうち所定の位置(本実施形態においては目標走行位置P)における曲率σcを決定する。なお、このときの所定の位置は、目標走行位置Pに限らず、例えば、目標走行位置Pから所定の距離だけ離れた位置、車両1から所定の距離だけ離れた位置等であってもよい。   In this case, the control device 10 proceeds to step ST5, and determines the curvature σc at a predetermined position (the target travel position P in the present embodiment) on the reference line M1. Note that the predetermined position at this time is not limited to the target travel position P, and may be, for example, a position away from the target travel position P by a predetermined distance, a position away from the vehicle 1 by a predetermined distance, or the like.

次のステップST6では、制御装置10は、基準線M1の曲率σcの値が、所定の曲率(以下、「第1曲率」という)σ1の値未満か否かを判定する。第1曲率σ1は、予め行われた実験等によって、車両1がカーブ路を走行中か否かを判別できるような曲率に設定されている。   In the next step ST6, the control device 10 determines whether or not the value of the curvature σc of the reference line M1 is less than a predetermined curvature (hereinafter referred to as “first curvature”) σ1. The first curvature σ1 is set to such a curvature that it can be determined whether or not the vehicle 1 is traveling on a curved road through experiments or the like that are performed in advance.

制御装置10は、ステップST6で、基準線M1の曲率σcの値が所定の第1曲率σ1以上である(車両1がカーブ路を走行中である)と判定した場合には、ステップST9に進み、ステップST3で決定された目標走行位置Pに従って車両1の操舵を制御する。   If the control device 10 determines in step ST6 that the value of the curvature σc of the reference line M1 is equal to or greater than the predetermined first curvature σ1 (the vehicle 1 is traveling on a curved road), the control device 10 proceeds to step ST9. Then, the steering of the vehicle 1 is controlled in accordance with the target travel position P determined in step ST3.

制御装置10は、ステップST6で、基準線M1の曲率σcの値が所定の第1曲率σ1未満であると判定した場合には、ステップST7に進む。   If the control device 10 determines in step ST6 that the value of the curvature σc of the reference line M1 is less than the predetermined first curvature σ1, the control device 10 proceeds to step ST7.

制御装置10は、ステップST7では、基準線M1の曲率σcの値が、所定の曲率(以下、「第2曲率」という。第2曲率は、第1曲率σ1よりも小さい値である)σ2の値より大きいか否かを判定する。第2曲率σ2は、予め行われた実験等によって、車両1が上り坂を走行中か否かを判別できるような曲率に設定されている。   In step ST7, the control device 10 determines that the value of the curvature σc of the reference line M1 is a predetermined curvature (hereinafter referred to as “second curvature”. The second curvature is a value smaller than the first curvature σ1). It is determined whether or not the value is larger. The second curvature σ2 is set to such a curvature that it can be determined whether or not the vehicle 1 is traveling uphill by an experiment or the like performed in advance.

制御装置10は、ステップST7で、基準線M1の曲率σcの値が所定の第2曲率σ2以下である(車両1が上り坂を走行中である)と判定した場合には、ステップST9に進み、ステップST3で決定された目標走行位置Pに従って車両1の操舵を制御する。   If the control device 10 determines in step ST7 that the value of the curvature σc of the reference line M1 is equal to or less than the predetermined second curvature σ2 (the vehicle 1 is traveling uphill), the control device 10 proceeds to step ST9. Then, the steering of the vehicle 1 is controlled in accordance with the target travel position P determined in step ST3.

制御装置10は、ステップST7で、基準線M1の曲率σcの値が所定の第2曲率σ2より大きい(車両1が「分岐路の手前の道路」又は「幅が広くなる道路」を走行中である)と判定した場合には、ステップST8に進み、左右のレーンマーク間の距離の変化に応じた目標走行位置Pの変化を抑制するように、ステップST3で決定された目標走行位置Pを補正する。   In step ST7, the control device 10 determines that the value of the curvature σc of the reference line M1 is larger than the predetermined second curvature σ2 (the vehicle 1 is traveling on the “road before the branch road” or the “road wide road”). If YES, the process proceeds to step ST8, and the target travel position P determined in step ST3 is corrected so as to suppress the change in the target travel position P according to the change in the distance between the left and right lane marks. To do.

詳細には、制御装置10は、次式(1)に従って、目標走行位置Pを補正するための補正量Δyを決定する。   Specifically, the control device 10 determines a correction amount Δy for correcting the target travel position P according to the following equation (1).

ここで、Wtは、現在の車両1の位置における左右のレーンマーク間の距離(以下、「第1距離」という)である。WTは、目標走行位置P(すなわち、所定時間Tが経過した後の車両1の予測位置)における左右のレーンマーク間の距離(以下、「第2距離」という)である。   Here, Wt is the distance between the left and right lane marks at the current position of the vehicle 1 (hereinafter referred to as “first distance”). WT is a distance (hereinafter referred to as “second distance”) between the left and right lane marks at the target travel position P (that is, the predicted position of the vehicle 1 after the predetermined time T has elapsed).

Δydは、基準線M1と実際の車両1の位置との間の距離(左右のレーンマーク間の距離方向における長さ)である(図5(a)は、Δydが0、すなわち車両1の位置(以下、「自車位置」という)Pvが基準線M1上に位置している例を示している)。   Δyd is the distance between the reference line M1 and the actual position of the vehicle 1 (the length in the distance direction between the left and right lane marks) (FIG. 5A shows that Δyd is 0, that is, the position of the vehicle 1 (Hereinafter, Pv is located on the reference line M1).

なお、Δydは、自車位置Pvが基準線M1よりも左右のレーンマークのうち曲率が大きくなっているレーンマーク(図5においては右のレーンマーク)の方に位置している場合に負となり(図5(b)参照)、自車位置Pvが基準線M1よりも左右のレーンマークのうち曲率が大きくなっていないレーンマーク(図5においては左のレーンマーク)の方に位置している場合には正となる(図5(c)参照)。   Note that Δyd is negative when the vehicle position Pv is located on the lane mark with the larger curvature of the lane marks on the left and right of the reference line M1 (the right lane mark in FIG. 5). (See FIG. 5 (b)), the vehicle position Pv is located on the lane mark (left lane mark in FIG. 5) whose curvature is not larger among the lane marks on the left and right of the reference line M1. In this case, it is positive (see FIG. 5C).

そして、制御装置10は、式(1)に従って決定された補正量Δyに応じて目標走行位置Pを補正して、新たな目標走行位置P’を得る。このとき、新たな目標走行位置P’は、基準線M1から左のレーンマークに向かってずらすように決定される。このため、新たな目標走行位置P’は、現時点の車両1の直進方向に位置する。このように、第1距離Wtから第2距離WTへの左右のレーンマーク間の距離の変化に応じて、目標走行位置Pが分岐路の方に向かうように変化することが防止される。従って、運転者の意に反した操舵制御がなされることを防止できる。   Then, the control device 10 corrects the target travel position P according to the correction amount Δy determined according to the equation (1) to obtain a new target travel position P ′. At this time, the new target travel position P ′ is determined so as to be shifted from the reference line M1 toward the left lane mark. Therefore, the new target travel position P ′ is located in the straight direction of the vehicle 1 at the current time. In this way, the target travel position P is prevented from changing toward the branch road in accordance with the change in the distance between the left and right lane marks from the first distance Wt to the second distance WT. Therefore, it is possible to prevent the steering control against the intention of the driver.

なお、所定時間Tは、例えば、予め行われた実験等によって、車両1の進行方向の先に分岐路があるか否かを精度良く判定できる程度の時間に設定されている。本実施形態では、例えば、所定時間Tは、0.5[sec]〜1[sec]程度の値に設定されている。なお、所定時間Tは、固定された値に設定されるのではなく、他の要素(例えば、車両1の走行速度)に応じて変化するように設定されていてもよい(例えば、車両1の走行速度が速い程、所定時間Tが短く設定される)。   The predetermined time T is set to such a time that it can be accurately determined whether or not there is a branch road ahead of the traveling direction of the vehicle 1 by, for example, an experiment performed in advance. In the present embodiment, for example, the predetermined time T is set to a value of about 0.5 [sec] to 1 [sec]. Note that the predetermined time T is not set to a fixed value, but may be set to change according to other factors (for example, the traveling speed of the vehicle 1) (for example, the vehicle 1). The faster the traveling speed, the shorter the predetermined time T is set).

制御装置10は、ステップST8の処理が終了すると、ステップST9に進む。制御装置10は、この場合には、ステップST8で補正された目標走行位置P’に従って車両1の操舵を制御する。ステップST9は、操舵制御部14により実行される処理である。   When the process of step ST8 ends, the control device 10 proceeds to step ST9. In this case, the control device 10 controls the steering of the vehicle 1 according to the target travel position P ′ corrected in step ST8. Step ST9 is a process executed by the steering control unit 14.

なお、ステップST9における車両1の操舵制御には、例えば、本出願人による特開平5−197423号公報等に記載された手法が用いられる。すなわち、制御装置10は、車両1を目標走行位置P(目標経路上に設定された目標点)まで到達させるための、車両1のヨーレートの目標値を決定して、車両1のヨーレートが該目標値に一致するように車両1の操舵を制御する。   For the steering control of the vehicle 1 in step ST9, for example, a technique described in Japanese Patent Laid-Open No. 5-197423 by the present applicant is used. That is, the control device 10 determines a target value of the yaw rate of the vehicle 1 for causing the vehicle 1 to reach the target travel position P (a target point set on the target route), and the yaw rate of the vehicle 1 is the target value. The steering of the vehicle 1 is controlled so as to match the value.

なお、本実施形態では、車両1の操舵制御として、特開平5−197423号公報等に記載された手法に基づいた制御を例に説明したが、車両1の操舵制御はこれに限らない。例えば、車両1の操舵制御として、本出願人による特開2006−15996号公報に記載された手法に基づいた制御が用いられてもよい。   In the present embodiment, as the steering control of the vehicle 1, the control based on the technique described in JP-A-5-197423 is described as an example, but the steering control of the vehicle 1 is not limited to this. For example, as a steering control of the vehicle 1, a control based on a technique described in Japanese Patent Application Laid-Open No. 2006-15996 by the present applicant may be used.

この場合、制御装置10は、前述のステップST3において、例えば、車両1が走行している道路の左右のレーンマークの中心を通る線(基準線)M2のうち車両1に最も近い点の曲率1/Rと、基準線M2に対する車両1の横ずれ量yc及び車両1の偏向角θhのうち少なくともいずれかとに基づいて、車両1の操舵を補助するトルク(操舵アシストトルク)の目標値(目標トルク)τを決定する。ここで、目標トルクτは、本発明の目標パラメータに相当する。   In this case, in step ST3 described above, the control device 10 has, for example, the curvature 1 of the point closest to the vehicle 1 among the lines (reference lines) M2 passing through the centers of the left and right lane marks of the road on which the vehicle 1 is traveling. / R and a target value (target torque) of torque (steering assist torque) for assisting steering of the vehicle 1 based on at least one of the lateral displacement amount yc of the vehicle 1 with respect to the reference line M2 and the deflection angle θh of the vehicle 1 τ is determined. Here, the target torque τ corresponds to the target parameter of the present invention.

そして、制御装置10は、前述のステップST8において、曲率1/R、横ずれ量yc及び偏向角θhの少なくともいずれかを、左右のレーンマーク間の距離の変化に応じた目標トルクτの変化を抑制するように補正する。そして、制御装置10は、前述のステップST9において、該補正された目標トルクτに応じて車両1の操舵制御を行う。   Then, in step ST8 described above, the control device 10 suppresses the change in the target torque τ according to the change in the distance between the left and right lane marks by using at least one of the curvature 1 / R, the lateral shift amount yc, and the deflection angle θh. Correct as follows. Then, in step ST9 described above, the control device 10 performs steering control of the vehicle 1 according to the corrected target torque τ.

これにより、分岐路等のように左右のレーンマーク間の距離が車両から離れるにつれて大きくなる条件下で、当該距離の変化に応じて車両1が分岐路の方に向かうように変化することが防止される。そのため、運転者の意に反した操舵制御がなされることを防止できる。   This prevents the vehicle 1 from changing toward the branch road in accordance with the change in the distance under the condition that the distance between the left and right lane marks increases as the distance from the vehicle increases. Is done. For this reason, it is possible to prevent the steering control against the intention of the driver.

ここで、本実施形態では、上記補正を含めた目標トルクτは、次の関係式(2−1)に従って決定される。   Here, in the present embodiment, the target torque τ including the correction is determined according to the following relational expression (2-1).

ここで、Δ(1/R)は、曲率1/Rの補正量であり、Δycは、横ずれ量ycの補正量であり、Δθhは、偏向角θhの補正量であり、y_actは、現時点での車両1の実際の位置であり、μは、車両1の走行速度(車速)である。Ka、Kb及びKcの各々は、目標トルクを算出するためのフィードバックゲイン係数である。また、「′」は微分を表す記号である(例えば、「x′」は、xの微分を表す)。また、Func()は、車両1が所定の曲率の道路を走行する際に、制御装置10による操舵制御による基本操舵アシストトルクの目標値を、所定の特性に従って決定する所定の関数である。   Here, Δ (1 / R) is the correction amount of the curvature 1 / R, Δyc is the correction amount of the lateral displacement amount yc, Δθh is the correction amount of the deflection angle θh, and y_act is currently Is the actual position of the vehicle 1, and μ is the traveling speed (vehicle speed) of the vehicle 1. Each of Ka, Kb, and Kc is a feedback gain coefficient for calculating the target torque. “′” Is a symbol representing differentiation (for example, “x ′” represents differentiation of x). Func () is a predetermined function that determines a target value of basic steering assist torque by steering control by the control device 10 according to a predetermined characteristic when the vehicle 1 travels on a road having a predetermined curvature.

また、C1は、左右のレーンマーク間の距離が大きくなることによる曲率1/Rの変化を抑制するような値を意味する。C2は、左右のレーンマーク間の距離が大きくなることによる横ずれ量ycの変化を抑制するような値を意味する。C3は、左右のレーンマーク間の距離が大きくなることによる偏向角θhの変化を抑制するような値を意味する。   C1 means a value that suppresses a change in curvature 1 / R due to an increase in the distance between the left and right lane marks. C2 means a value that suppresses a change in the lateral shift amount yc due to an increase in the distance between the left and right lane marks. C3 means a value that suppresses a change in the deflection angle θh due to an increase in the distance between the left and right lane marks.

ステップST4の判定結果がNOだった場合には、Δ(1/R)、Δyc及びΔθhは、0に設定される。   If the determination result in step ST4 is NO, Δ (1 / R), Δyc, and Δθh are set to zero.

以下、ステップST8において、制御装置10が、補正量Δ(1/R)、Δyc及びΔθhの各々を決定する方法について説明する。   Hereinafter, a method in which the control device 10 determines each of the correction amounts Δ (1 / R), Δyc, and Δθh in step ST8 will be described.

まず、制御装置10が、曲率1/Rを補正するための補正量Δ(1/R)を決定する方法について図6を参照して説明する。   First, a method in which the control device 10 determines the correction amount Δ (1 / R) for correcting the curvature 1 / R will be described with reference to FIG.

ここで、基準線M2のうち現時点の車両1の位置に最も近い位置(点)をAと規定し、基準線M2のうち所定の時間Δt経過後の車両1の位置に最も近い位置(点)をBと規定する。また、「点A及び点Bを通り」且つ「車両1の進行方向に平行な線のうち点Aを通る線が接線となる」円Oを規定する。なお、この円Oの半径はRである。そして、「点Bと円Oの中心点oとを通る線」と「円O」との交点のうち点B以外の点をCと規定する。   Here, a position (point) closest to the current position of the vehicle 1 in the reference line M2 is defined as A, and a position (point) closest to the position of the vehicle 1 after a predetermined time Δt has elapsed in the reference line M2. Is defined as B. Further, a circle O is defined that “passes through point A and point B” and “a line passing through point A among lines parallel to the traveling direction of the vehicle 1 becomes a tangent”. The radius of this circle O is R. A point other than the point B is defined as C among the intersections of the “line passing through the point B and the center point o of the circle O” and the “circle O”.

なお、所定の時間Δtは、前述した所定時間Tと同様である(車両1の進行方向の先に分岐路があるか否かを精度良く判定できる程度の時間。例えば、0.5[sec]〜1[sec]程度。また、所定の時間Δtは、固定値ではなく、他の要素に応じて変化するように設定されてもよい)。   Note that the predetermined time Δt is the same as the above-described predetermined time T (a time enough to determine whether or not there is a branch road ahead in the traveling direction of the vehicle 1. For example, 0.5 [sec] to 1 Further, the predetermined time Δt is not a fixed value, and may be set to change according to other factors.

このとき、「|BC| = 2R」であり、「∠BCA = ∠BAD = φ」であるので、次式(2−2)が成り立つ。   At this time, since “| BC | = 2R” and “∠BCA = ∠BAD = φ”, the following equation (2-2) is established.

ここで、「μΔt」が本発明における「車両の移動量」に相当する。   Here, “μΔt” corresponds to the “movement amount of the vehicle” in the present invention.

そして、式(2−2)を変形すると、次式(2−3)が得られる。   Then, when the formula (2-2) is modified, the following formula (2-3) is obtained.

また、△ABDに注目すると、次式(2−4)が成立することが分かる。   When attention is paid to ΔABD, it can be seen that the following expression (2-4) is established.

ここで、「|BD|」は、「WT−Wt」の半分の長さであるので、式(2−3)に式(2−4)を代入すると次式(2−5)が得られる。   Here, since “| BD |” is half the length of “WT-Wt”, the following equation (2-5) is obtained by substituting equation (2-4) into equation (2-3). .

式(2−5)で得られた半径Rの逆数により曲率1/Rが得られる。制御装置10は、このようにして得た曲率1/Rを、曲率1/Rの補正量Δ(1/R)として扱う。   The curvature 1 / R is obtained by the reciprocal of the radius R obtained by the equation (2-5). The control device 10 treats the curvature 1 / R thus obtained as a correction amount Δ (1 / R) of the curvature 1 / R.

そして、制御装置10は、基準線M2のうち車両1に最も近い位置の曲率1/Rに対して、この補正量Δ(1/R)を減算して、補正後の曲率を得る。   And the control apparatus 10 subtracts this correction amount (DELTA) (1 / R) with respect to the curvature 1 / R of the position nearest to the vehicle 1 among the reference lines M2, and obtains the curvature after correction | amendment.

次に、制御装置10が、横ずれ量ycを補正するための補正量Δycを決定する方法について説明する。   Next, a method in which the control device 10 determines the correction amount Δyc for correcting the lateral deviation amount yc will be described.

制御装置10は、現時点の車両1が走行している位置の左右のレーンマーク間の距離W(t)と、所定の時間Δt前に車両1が走行していた位置の左右のレーンマーク間の距離W(t-1)と、所定の時間Δt前の車両1の横ずれ量Δy(t-1)とに基づいて、次式(3)に従って、横ずれ量ycの補正量Δycを決定する。   The control device 10 determines the distance W (t) between the left and right lane marks at the current position where the vehicle 1 is traveling and the left and right lane marks at the position where the vehicle 1 was traveling before the predetermined time Δt. Based on the distance W (t−1) and the lateral displacement amount Δy (t−1) of the vehicle 1 before the predetermined time Δt, the correction amount Δyc of the lateral displacement amount yc is determined according to the following equation (3).

そして、制御装置10は、基準線M2に対する車両1の横ずれ量ycに対して、この補正量Δycを減算して、補正後の横ずれ量を得る。   And the control apparatus 10 subtracts this correction amount (DELTA) yc with respect to the lateral deviation amount yc of the vehicle 1 with respect to the reference line M2, and obtains the lateral deviation amount after correction | amendment.

次に、制御装置10が、偏向角θhを補正するための補正量Δθhを決定する方法について図7を参照して説明する。   Next, a method in which the control device 10 determines the correction amount Δθh for correcting the deflection angle θh will be described with reference to FIG.

制御装置10は、上記W(t),W(t-1)と、車速μとに基づいて、次の関係式(4)に従って、偏向角θhの補正量Δθhを決定する。   The control device 10 determines the correction amount Δθh of the deflection angle θh according to the following relational expression (4) based on the W (t), W (t−1) and the vehicle speed μ.

そして、制御装置10は、基準線M2に対する車両1の偏向角θhに対して、この補正量Δθhを減算して、補正後の偏向角を得る。   Then, the control device 10 subtracts this correction amount Δθh from the deflection angle θh of the vehicle 1 with respect to the reference line M2 to obtain a corrected deflection angle.

実際の車両1の偏向角θhよりも補正後の偏向角の方が小さくなる。従って、補正後の偏向角に基づいて目標トルクτを決定することは、左右のレーンマーク間の距離の変化に応じた基準線M2に対する車両1の偏向角θhの拡大を許容するように目標トルクτを決定することとなる。このような目標トルクτとなるように操舵アシストトルクが制御されることで、現時点における車両1の進行方向の変化が抑制される。   The corrected deflection angle is smaller than the actual deflection angle θh of the vehicle 1. Therefore, determining the target torque τ based on the corrected deflection angle allows the target torque τ to be increased with respect to the reference line M2 corresponding to the change in the distance between the left and right lane marks. τ will be determined. By controlling the steering assist torque so as to achieve such a target torque τ, a change in the traveling direction of the vehicle 1 at the present time is suppressed.

なお、上記関係式(2−1)において、Ka、Kb及びKcの各々は、その少なくともいずれかが0に設定される態様も取り得る。   In the relational expression (2-1), each of Ka, Kb, and Kc can take an embodiment in which at least one of them is set to 0.

また、上記説明においては、車両1が走行している現時点の位置の左右のレーンマーク間の距離W(t)と、所定の時間Δt前に車両1が走行していた位置の左右のレーンマーク間の距離W(t-1)とに基づいて補正量Δyc又はΔθhを決定しているが、例えば、現時点の車両1が走行している位置の左右のレーンマーク間の距離W(t)と、所定の時間Δt経過後に車両1が走行していると推定される位置の左右のレーンマーク間の距離W(t+1)とに基づいて補正量Δyc又はΔθhを決定してもよい。この場合には、上記式(3)及び(4)におけるW(t)はW(t+1)となり、W(t-1)はW(t)となる。   In the above description, the distance W (t) between the left and right lane marks at the current position where the vehicle 1 is traveling, and the left and right lane marks at the position where the vehicle 1 was traveling before the predetermined time Δt. The correction amount Δyc or Δθh is determined on the basis of the distance W (t−1) between, for example, the distance W (t) between the left and right lane marks at the current position where the vehicle 1 is traveling. The correction amount Δyc or Δθh may be determined based on the distance W (t + 1) between the left and right lane marks at the position where the vehicle 1 is estimated to travel after the predetermined time Δt has elapsed. In this case, W (t) in the above formulas (3) and (4) is W (t + 1), and W (t-1) is W (t).

また、同様に、上記式(1)及び式(2−5)において、WTを現在の車両1の位置における左右のレーンマーク間の距離と規定し、Wtを所定時間T(又は所定の時間Δt)前の車両1の位置における左右のレーンマーク間の距離と規定してもよい。   Similarly, in the above formulas (1) and (2-5), WT is defined as the distance between the left and right lane marks at the current position of the vehicle 1, and Wt is defined as a predetermined time T (or a predetermined time Δt). ) It may be defined as the distance between the left and right lane marks at the position of the previous vehicle 1.

1…車両、10…制御装置(操舵制御装置)、20…カメラ、12…認識部、13…決定部、14…操舵制御部、P…目標走行位置、M1…基準線、T…所定時間、M2…基準線、1/R…曲率、yc…横ずれ量、θh…偏向角、τ…目標トルク。   DESCRIPTION OF SYMBOLS 1 ... Vehicle, 10 ... Control apparatus (steering control apparatus), 20 ... Camera, 12 ... Recognition part, 13 ... Determination part, 14 ... Steering control part, P ... Target travel position, M1 ... Baseline, T ... Predetermined time, M2 ... reference line, 1 / R ... curvature, yc ... lateral deviation, .theta.h ... deflection angle, .tau .... target torque.

Claims (5)

車両の進行方向を撮像するカメラによる撮像画像に基づいて、前記車両が走行している道路の左右のレーンマークを認識するように構成された認識部と、前記認識部によって認識された左右のレーンマークの位置に基づいて、前記車両の操舵制御の目標とする目標パラメータを決定するように構成された決定部と、前記決定部によって決定された目標パラメータに従って、前記車両の操舵を制御するように構成された操舵制御部とを備える車両の操舵制御装置であって、
前記決定部は、前記認識部によって認識された左右のレーンマーク間の距離が、前記車両から離れるにつれて長くなるときに、前記距離の変化に応じた前記目標パラメータの変化を抑制するように、前記目標パラメータを補正することを特徴とする車両の操舵制御装置。
A recognition unit configured to recognize left and right lane marks of a road on which the vehicle is traveling based on an image captured by a camera that captures the traveling direction of the vehicle, and left and right lanes recognized by the recognition unit A determination unit configured to determine a target parameter for steering control of the vehicle based on the position of the mark, and to control steering of the vehicle according to the target parameter determined by the determination unit A vehicle steering control device comprising a configured steering control unit,
When the distance between the left and right lane marks recognized by the recognition unit becomes longer as the distance from the vehicle increases, the determination unit suppresses the change in the target parameter according to the change in the distance. A vehicle steering control device, wherein a target parameter is corrected.
請求項1に記載の車両の操舵制御装置において、
前記決定部は、
前記認識部によって認識された左右のレーンマーク間の中点を通る基準線を設定し、所定時間が経過した後に、該基準線に前記車両が位置するように、前記車両の目標位置とする目標走行位置を前記目標パラメータとして決定し、
前記認識部によって認識された左右のレーンマークのうちいずれか一方の曲率が大きくなることで、該左右のレーンマーク間の距離が前記車両から離れるにつれて長くなるときには、前記所定時間内における前記左右のレーンマーク間の距離の変化の半分の長さを算出し、前記補正として、前記目標走行位置を、前記左右のレーンマーク間の距離方向において、前記基準線から前記左右のレーンマークのうち曲率が大きくなっていない方のレーンマークの方に、前記算出された長さ分ずらす処理を行うことを特徴とする車両の操舵制御装置。
The vehicle steering control device according to claim 1,
The determination unit
A reference line that passes through the midpoint between the left and right lane marks recognized by the recognition unit is set, and a target that is the target position of the vehicle is set so that the vehicle is positioned on the reference line after a predetermined time has elapsed. Determine the travel position as the target parameter,
When the curvature of one of the left and right lane marks recognized by the recognition unit increases so that the distance between the left and right lane marks increases as the distance from the vehicle increases, the left and right lane marks within the predetermined time are increased. A half length of the change in the distance between the lane marks is calculated, and as the correction, the curvature of the left and right lane marks from the reference line in the distance direction between the left and right lane marks is calculated as the correction. A steering control device for a vehicle, wherein a process of shifting the calculated lane mark toward the lane mark that is not enlarged is performed.
請求項1に記載の車両の操舵制御装置において、
前記決定部は、
前記認識部によって認識された左右のレーンマーク間の中点を通る基準線を設定し、該基準線に前記車両が位置するように、前記基準線の曲率に基づいて、前記車両の操舵を制御するトルクの目標とする目標トルクを前記目標パラメータとして決定し、
前記左右のレーンマーク間の距離が前記車両から離れるにつれて長くなるときには、前記補正として、所定時間内における前記距離の変化と、前記車両の移動量とに基づいて、前記距離の変化に応じた前記目標トルクの変化を抑制するように前記基準線の曲率を補正して、該補正された曲率に基づいて前記目標トルクを決定する処理を行うことを特徴とする車両の操舵制御装置。
The vehicle steering control device according to claim 1,
The determination unit
A reference line passing through the midpoint between the left and right lane marks recognized by the recognition unit is set, and the steering of the vehicle is controlled based on the curvature of the reference line so that the vehicle is positioned on the reference line A target torque as a target of torque to be determined is determined as the target parameter;
When the distance between the left and right lane marks increases as the distance from the vehicle increases, the correction is performed based on the change in the distance based on the change in the distance within a predetermined time and the amount of movement of the vehicle. A steering control device for a vehicle, wherein a curvature of the reference line is corrected so as to suppress a change in the target torque, and the target torque is determined based on the corrected curvature.
請求項1又は3に記載の車両の操舵制御装置において、
前記決定部は、
前記認識部によって認識された左右のレーンマーク間の中点を通る基準線を設定し、該基準線に前記車両が位置するように、該基準線に対する前記車両の横ずれ量に基づいて、前記車両の操舵を制御するトルクの目標とする目標トルクを前記目標パラメータとして決定し、
前記認識部によって認識された左右のレーンマークのうちいずれか一方の曲率が大きくなることで、該左右のレーンマーク間の距離が前記車両から離れるにつれて長くなるときには、前記補正として、所定時間内における前記左右のレーンマーク間の距離の変化の半分の長さを算出し、前記基準線に対する前記車両の横ずれ量と、該算出された前記長さとの差を、前記車両の横ずれ量に置き換えて前記目標トルクを決定する処理を行うことを特徴とする車両の操舵制御装置。
The vehicle steering control device according to claim 1 or 3,
The determination unit
A reference line passing through a midpoint between the left and right lane marks recognized by the recognition unit is set, and the vehicle is based on a lateral deviation amount of the vehicle with respect to the reference line so that the vehicle is positioned on the reference line. A target torque that is a target of torque for controlling steering of the vehicle is determined as the target parameter,
When the curvature between one of the left and right lane marks recognized by the recognition unit increases so that the distance between the left and right lane marks increases as the distance from the vehicle increases, the correction is performed within a predetermined time. A half length of a change in the distance between the left and right lane marks is calculated, and the difference between the lateral displacement amount of the vehicle with respect to the reference line and the calculated length is replaced with the lateral displacement amount of the vehicle. A steering control device for a vehicle, which performs a process of determining a target torque.
請求項1,3及び4のいずれか1項に記載の車両の操舵制御装置において、
前記決定部は、
前記認識部によって認識された左右のレーンマーク間の中点を通る基準線を設定し、該基準線に前記車両が位置するように、該基準線に対する前記車両の偏向角に基づいて、前記車両の操舵を制御するトルクの目標とする目標トルクを前記目標パラメータとして決定し、
前記左右のレーンマーク間の距離が前記車両から離れるにつれて長くなるときには、前記補正として、所定時間内における前記距離の変化と前記車両の移動量とに基づいて、前記距離の変化に応じた前記基準線に対する前記車両の偏向角の拡大を許容して、前記車両の進行方向の変化を抑制する処理を行うことを特徴とする車両の操舵制御装置。
The vehicle steering control device according to any one of claims 1, 3, and 4,
The determination unit
Based on a deflection angle of the vehicle with respect to the reference line so that a reference line passing through a midpoint between the left and right lane marks recognized by the recognition unit is set and the vehicle is positioned on the reference line A target torque that is a target of torque for controlling steering of the vehicle is determined as the target parameter,
When the distance between the left and right lane marks becomes longer as the distance from the vehicle increases, the reference according to the change in the distance is used as the correction based on the change in the distance and the amount of movement of the vehicle within a predetermined time. A steering control device for a vehicle, wherein a process for suppressing a change in a traveling direction of the vehicle by allowing an increase in a deflection angle of the vehicle with respect to a line is performed.
JP2013086610A 2013-04-17 2013-04-17 Steering control device for vehicle Pending JP2014210456A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2013086610A JP2014210456A (en) 2013-04-17 2013-04-17 Steering control device for vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2013086610A JP2014210456A (en) 2013-04-17 2013-04-17 Steering control device for vehicle

Publications (1)

Publication Number Publication Date
JP2014210456A true JP2014210456A (en) 2014-11-13

Family

ID=51930590

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2013086610A Pending JP2014210456A (en) 2013-04-17 2013-04-17 Steering control device for vehicle

Country Status (1)

Country Link
JP (1) JP2014210456A (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015191445A (en) * 2014-03-28 2015-11-02 トヨタ自動車株式会社 Driving assistance device
WO2018008321A1 (en) * 2016-07-06 2018-01-11 日産自動車株式会社 Travel control method and travel control device
WO2021170140A1 (en) * 2020-02-28 2021-09-02 华为技术有限公司 Lane structure detection method and apparatus
WO2022110740A1 (en) * 2020-11-24 2022-06-02 华为技术有限公司 Method and apparatus for determining transverse planning constraint

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015191445A (en) * 2014-03-28 2015-11-02 トヨタ自動車株式会社 Driving assistance device
WO2018008321A1 (en) * 2016-07-06 2018-01-11 日産自動車株式会社 Travel control method and travel control device
KR20190017925A (en) * 2016-07-06 2019-02-20 닛산 지도우샤 가부시키가이샤 Driving control method and driving control device
CN109476306A (en) * 2016-07-06 2019-03-15 日产自动车株式会社 Travel control method and travel controlling system
JPWO2018008321A1 (en) * 2016-07-06 2019-05-23 日産自動車株式会社 Traveling control method and traveling control device
KR102035983B1 (en) 2016-07-06 2019-10-23 닛산 지도우샤 가부시키가이샤 Driving control method and driving control device
US10611374B2 (en) 2016-07-06 2020-04-07 Nissan Motor Co., Ltd. Drive control method and drive control apparatus
WO2021170140A1 (en) * 2020-02-28 2021-09-02 华为技术有限公司 Lane structure detection method and apparatus
WO2022110740A1 (en) * 2020-11-24 2022-06-02 华为技术有限公司 Method and apparatus for determining transverse planning constraint

Similar Documents

Publication Publication Date Title
KR101551096B1 (en) Lane changing apparatus and method of autonomous vehicle
JP5124875B2 (en) Vehicle travel support device, vehicle, vehicle travel support program
JP5966965B2 (en) Lane boundary departure control device and lane boundary departure suppression method
EP2741270B1 (en) Driving assistance apparatus and driving assistance method
US10147003B2 (en) Lane detection device and method thereof, curve starting point detection device and method thereof, and steering assistance device and method thereof
JP6363516B2 (en) Vehicle travel control device
JP6965739B2 (en) Vehicle control device
JP6600995B2 (en) Vehicle control apparatus and program
US20180099666A1 (en) Vehicle control device
US10339393B2 (en) Demarcation line recognition apparatus
JP2016018520A (en) Travel zone line recognition device and program
JP6354659B2 (en) Driving support device
JP6377942B2 (en) Driving assistance device
JP5739465B2 (en) Vehicle steering control device
JP6105524B2 (en) Traveling lane marking recognition device and traveling lane marking recognition program
JP2014210456A (en) Steering control device for vehicle
JP2016099719A (en) Travel section line recognition apparatus
JP6408935B2 (en) Traveling line recognition device
JP2015140114A (en) lateral displacement calculation device
JP6606472B2 (en) Runway shape recognition device, runway shape recognition method
JP5559650B2 (en) Lane estimation device
JP2015217737A (en) Drive support apparatus
US10906540B2 (en) Vehicle control apparatus
CN106483959A (en) A kind of set a distance under image space is with car control method
JP6011522B2 (en) Driving assistance device