JP2018167733A - Vehicle travelling control device - Google Patents

Vehicle travelling control device Download PDF

Info

Publication number
JP2018167733A
JP2018167733A JP2017067544A JP2017067544A JP2018167733A JP 2018167733 A JP2018167733 A JP 2018167733A JP 2017067544 A JP2017067544 A JP 2017067544A JP 2017067544 A JP2017067544 A JP 2017067544A JP 2018167733 A JP2018167733 A JP 2018167733A
Authority
JP
Japan
Prior art keywords
vehicle
control
steering
lane
motor
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
Application number
JP2017067544A
Other languages
Japanese (ja)
Other versions
JP6898636B2 (en
Inventor
小山 哉
Hajime Koyama
哉 小山
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.)
Subaru Corp
Original Assignee
Subaru Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Subaru Corp filed Critical Subaru Corp
Priority to JP2017067544A priority Critical patent/JP6898636B2/en
Publication of JP2018167733A publication Critical patent/JP2018167733A/en
Application granted granted Critical
Publication of JP6898636B2 publication Critical patent/JP6898636B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Power Steering Mechanism (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

To provide a vehicle travelling control device that allows a vehicle to travel along a target course without deviating the vehicle from a lane by prompting the driver to operate a steering wheel even when the vehicle passes through a sharp curve and the like without operating the steering wheel while keeping a smooth steering feeling at the time when the vehicle travels by operation of the steering wheel by the driver.SOLUTION: The vehicle travelling control device calculates target steering torque Tδ required for preventing an own vehicle from deviating from a lane on which a target course is set, outputs the torque to a steering control part 40 and controls steering. Further, the device calculates yaw moments Mz to be added to the own vehicle under following travelling control by which the own vehicle is made to follow-travel along the target course, calculates motor torque Trr which is generated by a second motor 17 and motor torque Trl which is generated by a third motor 18 on the basis of the added yaw moments Mz, and outputs the torque to a second motor control part 26 and a third motor control part 27.SELECTED DRAWING: Figure 2

Description

本発明は、操舵制御と車輪の制駆動力配分制御で発生するヨーモーメントにより目標コースに沿って走行する車線追従と車線からの逸脱を防止自在な車両の走行制御装置に関する。   The present invention relates to a vehicle travel control apparatus that can freely follow a lane and travel from a lane along a target course by a yaw moment generated by steering control and braking / braking force distribution control of wheels.

近年、車両においては、操舵制御に加え車輪の制駆動力配分制御により車両にヨーモーメントを発生させ、目標コースに沿って走行する追従走行制御や車線逸脱を防止する逸脱防止制御等の運転支援制御や自動運転制御を実行する技術が開発され実用化されている。例えば、特開2016−150683号公報(以下、特許文献1)では、操舵アシスト機構と左右輪のトルクベクタリング機構を備え、運転支援制御のために操舵アシスト機構により与えられる操舵アシストトルクの目標値と、運転支援制御のためにトルクベクタリング機構により与えられる左右輪の制駆動力差の目標値とを運転者による操舵トルクに基づいて決定する車両の運転支援制御装置の技術が開示されている。   In recent years, in a vehicle, driving support control such as follow-up running control that travels along a target course and departure prevention control that prevents lane departure by generating yaw moment by braking / driving force distribution control of wheels in addition to steering control And technology to execute automatic operation control has been developed and put into practical use. For example, in Japanese Unexamined Patent Publication No. 2006-150683 (hereinafter referred to as Patent Document 1), a steering assist torque and a left and right wheel torque vectoring mechanism are provided, and a steering assist torque target value provided by the steering assist mechanism for driving assistance control is disclosed. And a vehicle driving support control device that determines a target value of a braking / driving force difference between left and right wheels given by a torque vectoring mechanism for driving support control based on a steering torque by a driver is disclosed. .

特開2016−150683号公報Japanese Patent Laid-Open No. 2006-150683

ところで、車両にヨーモーメントを付加するには、上述の特許文献1に開示される運転支援制御装置のように操舵制御に加え、車輪の制駆動力配分制御で行うことが可能である。このような操舵制御と車輪の制駆動力配分制御とを備えた車両では、例えば、ドライバが操舵して走行しようとする目標コースからのずれを車輪の制駆動力配分制御により修正しながら走行すれば、スムーズな走行が可能である。しかしながら、車輪の制駆動力配分制御を上述のように補助的な特性で設定した場合、ドライバがステアリングホイールを保持していない自動運転の状態で、車輪の制駆動力配分制御により車両にヨーモーメントを付加している際に、例えば、急カーブ等を通過しようとする場合、車輪の制駆動力配分制御のみでは車両に付加するヨーモーメントが不足し、目標コースに沿って追従走行することが困難になる虞がある。また、ドライバにステアリングホイールの操作を促す必要もある。   By the way, in order to add a yaw moment to the vehicle, it is possible to perform the braking / driving force distribution control of the wheels in addition to the steering control as in the driving support control device disclosed in Patent Document 1 described above. In a vehicle equipped with such steering control and wheel braking / braking force distribution control, for example, the driver can travel while correcting the deviation from the target course to be steered by the driver by the wheel braking / driving force distribution control. Smooth running is possible. However, when the braking / driving force distribution control of the wheels is set with the auxiliary characteristics as described above, the yaw moment is applied to the vehicle by the braking / driving force distribution control of the wheels in the automatic driving state where the driver does not hold the steering wheel. For example, when trying to pass a sharp curve or the like, the yaw moment added to the vehicle is insufficient with only the braking / driving force distribution control of the wheels, and it is difficult to follow the target course. There is a risk of becoming. It is also necessary to prompt the driver to operate the steering wheel.

本発明は上記事情に鑑みてなされたもので、ドライバがステアリングホイールを操作して走行するときのスムーズな操舵感をそのままに、また、ドライバがステアリングホイールを操作していない自動運転の状態で、たとえ急カーブ等を通過する際においても、ドライバにステアリングホイールの操作を促しつつ車線から逸脱することなく目標コースに沿った車両の走行を可能とする車両の走行制御装置を提供することを目的としている。   The present invention has been made in view of the above circumstances, with the smooth steering feeling when the driver runs by operating the steering wheel as it is, and in the state of automatic driving where the driver does not operate the steering wheel, An object of the present invention is to provide a vehicle travel control device that enables a vehicle to travel along a target course without deviating from the lane while prompting a driver to operate a steering wheel even when passing a sharp curve or the like. Yes.

本発明の車両の走行制御装置の一態様は、自車両の走行環境情報に基づいて目標コースが予め設定される車線からの自車両の逸脱を防止する逸脱防止制御手段と、前記目標コースに沿って自車両を追従走行させる追従走行制御手段と、前記逸脱防止制御手段からの制御量に基づいて操舵制御する操舵制御手段と、前記追従走行制御手段からの制御量に基づいて車輪の制駆動力配分制御により車両にヨーモーメントを付加するヨーモーメント付加制御手段とを備えた。   According to one aspect of the vehicle travel control apparatus of the present invention, a departure prevention control means for preventing a departure of the host vehicle from a lane in which a target course is set in advance based on the travel environment information of the host vehicle, and the target course. A follow-up running control means for causing the vehicle to follow up, a steering control means for steering control based on a control amount from the departure prevention control means, and a braking / driving force of a wheel based on a control amount from the follow-up running control means Yaw moment addition control means for adding a yaw moment to the vehicle by distribution control is provided.

本発明による車両の走行制御装置によれば、ドライバがステアリングホイールを操作して走行するときのスムーズな操舵感をそのままに、また、ドライバがステアリングホイールを操作していない自動運転の状態で、たとえ急カーブ等を通過する際においても、ドライバにステアリングホイールの操作を促しつつ車線から逸脱することなく目標コースに沿った車両の走行が可能となる。   According to the vehicle travel control device of the present invention, the smooth steering feeling when the driver travels by operating the steering wheel is kept as it is, and in the automatic driving state where the driver does not operate the steering wheel, for example, Even when passing a sharp curve or the like, the vehicle can travel along the target course without deviating from the lane while prompting the driver to operate the steering wheel.

本発明の実施の一形態に係る車両の全体構成図である。1 is an overall configuration diagram of a vehicle according to an embodiment of the present invention. 本発明の実施の一形態に係る制御ユニットの機能ブロック説明図である。It is functional block explanatory drawing of the control unit which concerns on one Embodiment of this invention. 本発明の実施の一形態に係る、X−Y座標上における自車両及び車線と各パラメータの説明図である。It is explanatory drawing of the own vehicle, lane, and each parameter on XY coordinate based on one Embodiment of this invention. 本発明の実施の一形態に係る、自車両の推定される車両軌跡と目標コースの車幅方向における位置のズレ量の説明図である。It is explanatory drawing of the deviation | shift amount of the position in the vehicle width direction of the estimated vehicle locus | trajectory of the own vehicle and a target course based on one Embodiment of this invention. 本発明の実施の一形態に係る、各付加ヨーモーメントの特性マップで、図5(a)は自車両の幅方向における目標コースと自車位置とのズレ量に応じて設定される付加ヨーモーメントの特性マップの一例を示し、図5(b)は自車両に作用する外乱により生じる自車両の幅方向における目標コースと自車位置とのズレ量に応じて設定される付加ヨーモーメントの特性マップの一例を示し、図5(c)は目標コースの進行方向と自車両の進行方向の角度のズレ量に応じて設定される付加ヨーモーメントの特性マップの一例を示す。FIG. 5A is a characteristic map of each additional yaw moment according to the embodiment of the present invention, and FIG. 5A is an additional yaw moment set in accordance with the amount of deviation between the target course and the vehicle position in the width direction of the vehicle. FIG. 5B shows an additional yaw moment characteristic map that is set according to the amount of deviation between the target course and the vehicle position in the width direction of the host vehicle caused by a disturbance acting on the host vehicle. FIG. 5C shows an example of an additional yaw moment characteristic map that is set in accordance with the amount of deviation of the angle between the traveling direction of the target course and the traveling direction of the host vehicle. 本発明の実施の一形態に係る、車線追従から車線からの逸脱防止を経て車線追従に戻る制御の一例を示す説明図である。It is explanatory drawing which shows an example of the control which returns to a lane following via the deviation prevention from a lane according to one Embodiment of this invention.

以下、図面に基づいて本発明の実施の形態を説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings.

図1において、符号1は自車両を示し、符号2は自車両1の駆動系、符号3は自車両1の操舵系を示す。   In FIG. 1, reference numeral 1 indicates the host vehicle, reference numeral 2 indicates a drive system of the host vehicle 1, and reference numeral 3 indicates a steering system of the host vehicle 1.

駆動系2は、エンジン11、クラッチ機構12、第1モータ13、変速機14、減速装置15、駆動輪(左前輪16fl、右前輪16fr)から構成される前輪駆動力伝達経路と、第2モータ17、第3モータ18、減速装置(左減速装置19rl、右減速装置19rr)及び駆動輪(左後輪20rl、右後輪20rr)から構成される後輪駆動力伝達経路とを備える4輪駆動可能な構成になっている。   The drive system 2 includes a front wheel driving force transmission path composed of an engine 11, a clutch mechanism 12, a first motor 13, a transmission 14, a reduction gear 15, drive wheels (left front wheel 16fl, right front wheel 16fr), and a second motor. 17, a four-wheel drive including a third motor 18, a reduction gear (left reduction gear 19 rl, right reduction gear 19 rr), and a rear wheel driving force transmission path composed of drive wheels (left rear wheel 20 rl, right rear wheel 20 rr). It has a possible configuration.

前輪駆動力伝達経路では、エンジン11及び第1モータ13の駆動力が、変速機14及び減速装置15を介して前側の駆動輪(左前輪16fl、右前輪16fr)に伝達される。また、後輪駆動力伝達経路では、第2モータ17の駆動力が、右減速装置19rrを介して右後輪20rrに伝達され、第3モータ18の駆動力が、左減速装置19rlを介して左後輪20rlに伝達される。   In the front wheel driving force transmission path, the driving force of the engine 11 and the first motor 13 is transmitted to the front driving wheels (the left front wheel 16fl and the right front wheel 16fr) via the transmission 14 and the reduction gear 15. In the rear wheel driving force transmission path, the driving force of the second motor 17 is transmitted to the right rear wheel 20rr via the right reduction gear 19rr, and the driving force of the third motor 18 is transferred via the left reduction gear 19rl. It is transmitted to the left rear wheel 20rl.

第1モータ13は、バッテリ装置21に蓄えられている電力により駆動され、またエンジン11の出力トルクによって回転して発電し、発電した電力をバッテリ装置21に蓄電する。第2モータ17及び第3モータ18は、バッテリ装置21の蓄電電力及び第1モータ13で発電された電力のうちの少なくとも一方の電力により駆動される。   The first motor 13 is driven by the electric power stored in the battery device 21, and is rotated by the output torque of the engine 11 to generate electric power, and the generated electric power is stored in the battery device 21. The second motor 17 and the third motor 18 are driven by at least one of the stored power of the battery device 21 and the power generated by the first motor 13.

そして、エンジン制御部22は、制御ユニット50から出力されるエンジントルク指令値に基づいてスロットル開度を制御することでエンジン11のトルクを制御する。変速機制御部23は、制御ユニット50から出力される変速指令値に基づいて変速機14の変速比を制御する。バッテリ制御部24は、バッテリ装置21の電圧及び電流を検出してバッテリの充電状態(State of charge:SOC)を演算する。第1モータ制御部25、ヨーモーメント付加制御手段としての第2モータ制御部26及び第3モータ制御部27は、制御ユニット50から出力される第1モータトルク指令値、第2モータトルク指令値及び第3モータトルク指令値に基づいて、第1モータ13、第2モータ17及び第3モータ18のトルクをそれぞれ制御する。   The engine control unit 22 controls the torque of the engine 11 by controlling the throttle opening based on the engine torque command value output from the control unit 50. The transmission control unit 23 controls the gear ratio of the transmission 14 based on the shift command value output from the control unit 50. The battery control unit 24 detects the voltage and current of the battery device 21 and calculates the state of charge (SOC) of the battery. The first motor control unit 25, the second motor control unit 26 and the third motor control unit 27 as the yaw moment addition control means are a first motor torque command value, a second motor torque command value output from the control unit 50, and Based on the third motor torque command value, the torques of the first motor 13, the second motor 17, and the third motor 18 are controlled.

一方、自車両1の操舵系3は、ステアリングホイール31から、ステアリングシャフト31aが延出されており、ステアリングシャフト31aの前端は、ユニバーサルジョイント32a及びジョイント軸32bから成るジョイント部32を介してステアリングギヤボックス34から突出されたピニオン軸35と連結されている。   On the other hand, in the steering system 3 of the host vehicle 1, a steering shaft 31a extends from a steering wheel 31, and the front end of the steering shaft 31a is provided with a steering gear via a joint portion 32 including a universal joint 32a and a joint shaft 32b. The pinion shaft 35 protruding from the box 34 is connected.

ステアリングギヤボックス34からは、左前輪16flに向けてタイロッド36flが延出される一方、右前輪16frに向けてタイロッド36frが延出されている。タイロッド36fl、36frのタイロッドエンドは、ナックルアーム37fl、37frを介して、それぞれの側の車輪16fl、16frを回転自在に支持するアクスルハウジング38fl、38frと連結されている。   A tie rod 36fl extends from the steering gear box 34 toward the left front wheel 16fl, while a tie rod 36fr extends toward the right front wheel 16fr. The tie rod ends of the tie rods 36fl and 36fr are connected to axle housings 38fl and 38fr that rotatably support the wheels 16fl and 16fr on the respective sides via knuckle arms 37fl and 37fr.

また、自車両1の操舵系3には、周知のラックアシスト型等の電動パワーステアリング機構39が設けられている。この電動パワーステアリング機構39のパワーステアリング用電動モータは、図示しないパワーステアリング用モータ駆動部により駆動され、パワーステアリング用モータ駆動部は操舵制御手段としての操舵制御部40からの信号に基づいて制御される。   Further, the steering system 3 of the host vehicle 1 is provided with a known rack assist type electric power steering mechanism 39. The electric motor for power steering of the electric power steering mechanism 39 is driven by a power steering motor driving section (not shown), and the power steering motor driving section is controlled based on a signal from a steering control section 40 as steering control means. The

制御ユニット50には、カメラ装置(ステレオカメラ、単眼カメラ、カラーカメラ等)、レーダ装置(レーザレーダ、ミリ波レーダ等)、ソナー等で構成され、自車両の走行する走行環境情報を検出し、走行環境を認識する走行環境認識装置41、自車位置情報(緯度・経度、移動方向等)を検出して地図情報上に自車両位置の表示、及び、目的地までの経路誘導を行うナビゲーションシステム42、車速Vを検出する車速センサ43、操舵角δを検出する操舵角センサ44、ヨーレートγを検出するヨーレートセンサ45等のセンサ、スイッチが接続されている。   The control unit 50 includes a camera device (stereo camera, monocular camera, color camera, etc.), a radar device (laser radar, millimeter wave radar, etc.), sonar, etc., and detects traveling environment information in which the vehicle travels. A travel environment recognition device 41 for recognizing a travel environment, a navigation system that detects own vehicle position information (latitude / longitude, moving direction, etc.), displays the position of the own vehicle on map information, and guides a route to the destination. 42, a vehicle speed sensor 43 for detecting the vehicle speed V, a steering angle sensor 44 for detecting the steering angle δ, a sensor such as a yaw rate sensor 45 for detecting the yaw rate γ, and switches are connected.

走行環境認識装置41は、例えば、ステレオカメラで構成される場合、このステレオカメラは、車室内の天井前方に一定の間隔をもって取り付けられ、車外の対象を異なる視点からステレオ撮像する1組のカメラと、このカメラからの画像データを処理するステレオ画像処理装置とから構成されている。   For example, when the traveling environment recognition device 41 is configured by a stereo camera, the stereo camera is attached to the front of the ceiling in the vehicle interior at a certain interval, and a set of cameras that captures images of objects outside the vehicle from different viewpoints. And a stereo image processing apparatus for processing image data from the camera.

走行環境認識装置41のステレオ画像処理装置における、カメラからの画像データの処理は、例えば以下のように行われる。まず、カメラで撮像した自車両の進行方向の1組のステレオ画像対に対し、対応する位置のずれ量から距離情報を求め、距離画像を生成する。   The processing of image data from the camera in the stereo image processing apparatus of the traveling environment recognition apparatus 41 is performed as follows, for example. First, distance information is obtained from a pair of stereo image pairs taken in the traveling direction of the host vehicle captured by the camera from a corresponding positional shift amount, and a distance image is generated.

白線等の車線区画線のデータの認識では、白線は道路面と比較して高輝度であるという知得に基づき、道路の幅方向の輝度変化を評価して、画像平面における左右の車線区画線の位置を画像平面上で特定する。この車線区画線の実空間上の位置(x,y,z)は、画像平面上の位置(i,j)とこの位置に関して算出された視差とに基づいて、すなわち、距離情報に基づいて、周知の座標変換式より算出される。自車両の位置を基準に設定された実空間の座標系は、本実施の形態では、図3に示すように、カメラの中央真下の道路面を原点として、車両前後方向をX軸、車幅方向(車両横方向)をY軸、車高方向をZ軸とする。このとき、z=0のx−y平面は、道路が平坦な場合、道路面と一致する。道路モデルは、道路上の自車両の走行レーンを距離方向に複数区間に分割し、各区間における左右の車線区画線を所定に近似して連結することによって表現し、取得される。   In recognition of lane markings such as white lines, the left and right lane markings on the image plane are evaluated on the basis of the knowledge that the white lines are brighter than the road surface. Is specified on the image plane. The position (x, y, z) of the lane marking in the real space is based on the position (i, j) on the image plane and the parallax calculated with respect to this position, that is, based on the distance information. It is calculated from a known coordinate conversion formula. In the present embodiment, the coordinate system of the real space set based on the position of the host vehicle is, as shown in FIG. 3, with the road surface directly below the center of the camera as the origin, the vehicle longitudinal direction is the X axis, the vehicle width The direction (vehicle lateral direction) is the Y axis, and the vehicle height direction is the Z axis. At this time, the xy plane at z = 0 coincides with the road surface when the road is flat. The road model is expressed and acquired by dividing the traveling lane of the host vehicle on the road into a plurality of sections in the distance direction, and connecting the left and right lane markings in each section to a predetermined approximation.

また、走行環境認識装置41は、三次元の距離分布を表す距離画像のデータを基に周知のグルーピング処理を行い、側壁データ、立体物データ等の枠(ウインドウ)と比較し、道路に沿って存在するガードレール、縁石等の側壁データを抽出すると共に、立体物を、歩行者、二輪車、四輪車(車両)、その他の立体物の種類に分類して抽出する。また、認識された車両の中で、例えば、自車両1に最も近く、同じ車両として設定時間以上連続して認識された車両を先行車として抽出する。これら立体物の情報としては、上述の立体物の種類、自車両からの距離、方向、中心位置の他に、当該立体物の自車両に最も近い部位の相対的な位置、速度、立体物の進行方向の自車両の進行方向に対するなす角度の各情報が入力される。   The traveling environment recognition device 41 performs a well-known grouping process on the basis of distance image data representing a three-dimensional distance distribution, and compares it with a frame (window) such as side wall data and three-dimensional object data along the road. Side wall data such as existing guardrails and curbs are extracted, and three-dimensional objects are classified and extracted into pedestrians, two-wheeled vehicles, four-wheeled vehicles (vehicles), and other three-dimensional types. In addition, among the recognized vehicles, for example, a vehicle that is closest to the host vehicle 1 and is continuously recognized as the same vehicle for a set time or longer is extracted as a preceding vehicle. As information of these three-dimensional objects, in addition to the type of the three-dimensional object, the distance from the own vehicle, the direction, and the center position, the relative position of the part closest to the own vehicle of the three-dimensional object, the speed, Information on the angle formed by the traveling direction with respect to the traveling direction of the host vehicle is input.

また、上述の車線区画線情報、立体物情報については、それぞれ信頼度が走行環境認識装置41において設定され、これら信頼度情報も共に制御ユニット50に入力される。   Further, for the above-described lane marking information and three-dimensional object information, the reliability is set in the traveling environment recognition device 41, and the reliability information is also input to the control unit 50.

車線区画線情報の信頼度は、例えば、カメラにて撮像された画像上のレーンの中で判定された処理領域内に存在する車線区画線の特徴量が画像上で線上に並ぶ多さによって信頼度を算出する。エリアの中に理想的な直線実車線区画線がある場合に存在する車線区画線の特徴量の多さを1と設定し、まったく特徴量が存在しない場合、もしくは線上に並んでいると判定できない場合に0と設定される。そして、予め設定しておいた閾値以上の信頼度で車線が検出される場合に車線が存在すると判定する。   The reliability of the lane line information depends on the number of feature values of the lane line existing in the processing area determined in the lane on the image captured by the camera, for example, on the line. Calculate the degree. When there is an ideal straight solid lane line in the area, the feature quantity of the lane line that exists is set to 1, and if there is no feature quantity at all, or it cannot be judged as being aligned on the line In this case, 0 is set. And when a lane is detected with the reliability more than the preset threshold value, it determines with a lane existing.

また、立体物の信頼度は、例えば、設定した領域内で検出された立体物が同じ立体物と連続して認識される時間に応じて設定され、同じ立体物と連続して認識されるほど信頼度が高く1に設定され、連続して認識される時間が少ないほど信頼度が低く0に設定される。そして、予め設定しておいた閾値以上の信頼度で立体物が検出される場合に立体物が存在すると判定される。立体物が存在すると認識された場合、立体物に関する情報の立体物の自車両に対する前後方向の位置、立体物の自車両に対する横方向の位置、立体物の進行方向の自車両の進行方向に対するなす角度は、検出される安定度(例えば、連続して認識される時間)に応じてそれぞれ信頼度が設定される。そして、それぞれのパラメータ毎に予め設定された信頼度の閾値以上の場合に、当該パラメータの検出が行われたと判定され、信頼度の閾値に達しない場合は、当該パラメータの検出が行われないと判定される。   In addition, the reliability of the three-dimensional object is set according to the time for which the three-dimensional object detected in the set region is continuously recognized as the same three-dimensional object, for example, so that the three-dimensional object is continuously recognized as the same three-dimensional object. The reliability is set to high 1 and the reliability is set to 0 as the continuous recognition time decreases. And when a solid object is detected with the reliability more than the preset threshold value, it determines with a solid object existing. If it is recognized that a three-dimensional object exists, the position of the information about the three-dimensional object in the front-rear direction of the three-dimensional object with respect to the own vehicle, the position of the three-dimensional object in the lateral direction with respect to the own vehicle, and the traveling direction of the three-dimensional object with respect to the traveling direction of the own vehicle. As for the angle, the reliability is set according to the detected stability (for example, continuously recognized time). And when it is more than the reliability threshold value preset for each parameter, it is determined that the parameter is detected, and when the reliability threshold value is not reached, the parameter is not detected. Determined.

また、ナビゲーションシステム42は、周知のシステムであり、例えば、GPS(Global Positioning System)衛星からの電波信号を受信して車両の位置情報(緯度、経度)を取得し、センサ33から車速を取得し、また、地磁気センサあるいはジャイロセンサ等により、移動方向情報を取得する。そして、ナビゲーションシステム42は、ナビゲーション機能を実現するための経路情報を生成するナビECUと、地図情報(サプライヤデータ、及び、所定に更新されたデータ)を記憶する地図データベース(以上、何れも図示せず)を備え、情報を報知装置(図示せず)から出力する。   The navigation system 42 is a well-known system. For example, the navigation system 42 receives a radio signal from a GPS (Global Positioning System) satellite, acquires vehicle position information (latitude, longitude), and acquires a vehicle speed from the sensor 33. Further, the moving direction information is acquired by a geomagnetic sensor or a gyro sensor. The navigation system 42 includes a navigation ECU that generates route information for realizing the navigation function, and a map database that stores map information (supplier data and data updated in a predetermined manner). And information is output from a notification device (not shown).

ナビECUは、利用者によって指定された目的地までの経路情報を地図画像に重ねて報知装置で表示させるとともに、検出された車両の位置、速度、走行方向等の情報に基づき、車両の現在位置を報知装置上の地図画像に重ねて表示する。また、地図データベースには、ノードデータ、施設データ等の道路地図を構成するのに必要な情報が記憶されている。ノードデータは、地図画像を構成する道路の位置及び形状に関するものであり、例えば道路(車線)の幅方向中心点、道路の分岐点(交差点)を含む道路上の点(ノード点)の座標(緯度、経度)、当該ノード点が含まれる道路の方向、種別(例えば、高速道路、幹線道路、市道といった情報)、当該ノード点における道路のタイプ(直線区間、円弧区間(円弧曲線部)、クロソイド曲線区間(緩和曲線部))及びカーブ曲率(或いは、半径)のデータが含まれる。   The navigation ECU superimposes the route information to the destination designated by the user on the map image and displays it on the notification device, and based on the detected vehicle position, speed, traveling direction, etc., the current position of the vehicle Are superimposed on the map image on the notification device. The map database stores information necessary for constructing a road map such as node data and facility data. The node data relates to the position and shape of the road constituting the map image. For example, the coordinates of the points (node points) on the road including the center point in the width direction of the road (lane) and the branch point (intersection) of the road ( (Latitude, longitude), direction of road including the node point, type (for example, information such as expressway, main road, city road), type of road at the node point (straight section, arc section (arc curve section)), Clothoid curve section (relaxation curve section)) and curve curvature (or radius) data are included.

そして、制御ユニット50は、上述の各センサ41〜44からの各入力信号に基づき、目標コースが設定される車線からの逸脱を防止する逸脱防止制御の制御量(目標操舵トルクTδ)を算出し、目標操舵トルクTδは操舵制御部40に出力して操舵制御する。また、目標コースに沿って自車両を追従走行させる追従走行制御の制御量(自車両に付加するヨーモーメントMz)を算出し、この付加ヨーモーメントMzに基づき第2モータ17に発生させるモータトルクTrrと第3モータ18に発生させるモータトルクTrlを算出して第2モータ制御部26と第3モータ制御部27に出力する。   Then, the control unit 50 calculates a control amount (target steering torque Tδ) of departure prevention control for preventing a departure from the lane where the target course is set based on the input signals from the respective sensors 41 to 44 described above. The target steering torque Tδ is output to the steering control unit 40 for steering control. Also, a control amount (yaw moment Mz to be added to the host vehicle) for tracking the host vehicle to follow the host vehicle along the target course is calculated, and the motor torque Trr generated by the second motor 17 based on the additional yaw moment Mz. The motor torque Trl generated by the third motor 18 is calculated and output to the second motor control unit 26 and the third motor control unit 27.

このため、制御ユニット50は、図2に示すように、走行情報取得部50a、逸脱防止制御部50b、車線追従制御部50cから主要に構成されている。   For this reason, as shown in FIG. 2, the control unit 50 is mainly composed of a travel information acquisition unit 50a, a departure prevention control unit 50b, and a lane tracking control unit 50c.

走行情報取得部50aは、上述の各センサ41〜45からの各信号が入力され、逸脱防止制御と車線追従制御を行うのに必要な自車両1が走行する車線情報を取得すると共に、自車両1の走行状態を取得する。   The travel information acquisition unit 50a receives the signals from the sensors 41 to 45 described above, acquires the lane information on which the host vehicle 1 travels to perform the departure prevention control and the lane tracking control, and the host vehicle. 1 traveling state is acquired.

具体的には、本実施の形態では、車線追従制御を行う自車両1の目標コースは車線中央に設定するものとし、車線について、以下の各パラメータが算出されている。   Specifically, in the present embodiment, the target course of the host vehicle 1 that performs lane tracking control is set at the center of the lane, and the following parameters are calculated for the lane.

ここで、走行環境認識装置41で認識された車線区画線から求めることができるパラメータの導出について、図3を基に説明する。   Here, derivation of parameters that can be obtained from the lane markings recognized by the travel environment recognition device 41 will be described with reference to FIG.

自車両1の左側の車線区画線は最小自乗法により、以下の(1)式により近似される。   The lane marking on the left side of the host vehicle 1 is approximated by the following equation (1) by the method of least squares.

y=AL・x+BL・x+CL …(1)
また、自車両1の右側の車線区画線は最小自乗法により、以下の(2)式により近似される。
y = AL · x 2 + BL · x + CL (1)
Further, the lane marking on the right side of the host vehicle 1 is approximated by the following equation (2) by the method of least squares.

y=AR・x+BR・x+CR …(2)
ここで、上述の(1)式、(2)式における、「AL」と「AR」は、それぞれの曲線における曲率を示し、左側の白線の曲率κlは、2・ALであり、右側の白線の曲率κrは、2・ARである。従って、車線中央を目標コースとした場合、目標コースの曲率κは、(κl+κr)/2で算出される。
y = AR · x 2 + BR · x + CR (2)
In the above equations (1) and (2), “AL” and “AR” indicate the curvatures in the respective curves, the curvature κl of the left white line is 2 · AL, and the right white line The curvature κr is 2 · AR. Accordingly, when the center of the lane is the target course, the curvature κ of the target course is calculated by (κl + κr) / 2.

また、(1)式、(2)式における、「BL」と「BR」は、それぞれの曲線の自車両1の幅方向における傾きを示し、「CL」と「CR」は、それぞれの曲線の自車両1の幅方向における位置を示す。   In the equations (1) and (2), “BL” and “BR” indicate the inclination of each curve in the width direction of the host vehicle 1, and “CL” and “CR” indicate the respective curves. The position in the width direction of the host vehicle 1 is shown.

このため、自車両1の走行車線(目標コース)に対して自車両1の進行方向がなす対車線ヨー角(以下、自車両1の対車線ヨー角)θyawを、上述の(1)、(2)の近似式により、以下の(3)式により算出する。   For this reason, the on-lane yaw angle (hereinafter referred to as the on-vehicle yaw angle) θyaw formed by the traveling direction of the own vehicle 1 with respect to the travel lane (target course) of the own vehicle 1 is set to the above-described (1), ( It calculates with the following (3) Formula by the approximation formula of 2).

θyaw=tan−1((BL+BR)/2) …(3)
また、現時点における車線の中央(目標コース)からの自車両位置である車線幅方向車両横位置yvは、以下の(4)式により算出できる。
θyaw = tan −1 ((BL + BR) / 2) (3)
Further, the vehicle lateral position yv in the lane width direction, which is the vehicle position from the center of the lane at the current time (target course), can be calculated by the following equation (4).

yv=(CL+CR)/2 …(4)
更に、車線区画線から自車両1までの距離Lは、例えば、以下の(5)式により算出される。
yv = (CL + CR) / 2 (4)
Furthermore, the distance L from the lane marking to the host vehicle 1 is calculated by the following equation (5), for example.

L=((CL−CR)−W)/2−yv …(5)
ここで、Wは車幅である。
L = ((CL-CR) -W) / 2-yv (5)
Here, W is a vehicle width.

また、予め設定する前方注視点(位置)における自車両1の幅方向における目標コースと自車位置とのズレ量Δyは、図4に示すように、例えば、以下の(6)式により算出できる。   Further, the deviation amount Δy between the target course and the vehicle position in the width direction of the host vehicle 1 at the preset forward gazing point (position) can be calculated by the following equation (6), for example, as shown in FIG. .

Δy=(yl+yr)/2−yvv …(6)
この(6)式において、yvvは車両の前方注視点(位置)(0,xv)のx座標における推定車両軌跡のy座標であり、前方注視点(0,xv)の前方注視距離(z座標)であるxvは、本実施の形態では、xv=tc・Vで算出される。ここで、tcは予め設定しておいた予見時間であり、例えば、1.2secに設定されている。
Δy = (yl + yr) / 2−yvv (6)
In this equation (6), yvv is the y coordinate of the estimated vehicle trajectory at the x coordinate of the vehicle's forward gaze point (position) (0, xv), and the front gaze distance (z coordinate) of the front gaze point (0, xv). Xv in the present embodiment is calculated by xv = tc · V. Here, tc is a preset preview time, and is set to 1.2 sec, for example.

従って、yvvは、車両の走行状態に基づいて車両の諸元や車両固有のスタビリティファクタAs等を用いる場合には、例えば、以下の(7)式で算出することができる。
yvv=(1/2)・(1/(1+As・V))・(δ/Lw)
・(tc・V) …(7)
ここで、Lwはホイールベースである。また、(6)式における、ylは前方注視点(0,xv)のx座標における左車線区画線のy座標であり、yrは前方注視点(0,xv)のx座標における右車線区画線のy座標である。
Therefore, yvv can be calculated by, for example, the following equation (7) when using vehicle specifications, vehicle-specific stability factor As, or the like based on the running state of the vehicle.
yvv = (1/2) · (1 / (1 + As · V 2 )) · (δ / Lw)
・ (Tc ・ V) 2 (7)
Here, Lw is a wheel base. In the equation (6), yl is the y coordinate of the left lane line in the x coordinate of the forward gazing point (0, xv), and yr is the right lane line in the x coordinate of the forward gazing point (0, xv). Y coordinate.

尚、上述のyvvは、車速Vやヨーレートγを用いて、以下の(8)式で算出することもでき、或いは、画像情報を基に、以下の(9)式で算出することもできる。
yvv=(1/2)・(γ/V)・(V・tc) …(8)
yvv=(1/2)・κ・(V・tc) …(9)
尚、tcをゼロに設定した場合、Δyは、図3中に示すように、現時点における目標コースと自車両1との位置のズレ量と同値になる。
The above yvv can be calculated by the following equation (8) using the vehicle speed V and the yaw rate γ, or can be calculated by the following equation (9) based on the image information.
yvv = (1/2) · (γ / V) · (V · tc) 2 (8)
yvv = (1/2) · κ · (V · tc) 2 (9)
When tc is set to zero, Δy has the same value as the amount of deviation between the target course and the vehicle 1 at the current time, as shown in FIG.

こうして、走行情報取得部50aで算出された逸脱防止制御と車線追従制御を行うのに必要な自車両1が走行する車線情報は、上述の各センサ41〜45からの各信号と共に、逸脱防止制御部50b、車線追従制御部50cに出力される。   Thus, the lane information on which the host vehicle 1 travels necessary for performing the departure prevention control and the lane tracking control calculated by the traveling information acquisition unit 50a is included in the departure prevention control together with the signals from the sensors 41 to 45 described above. Is output to the unit 50b and the lane following control unit 50c.

逸脱防止制御部50bは、車線が認識されている場合に、例えば、以下の(10)式により、現在の走行状態で車線から逸脱する車線逸脱予想時間t_tlcを算出する。   When the lane is recognized, the departure prevention control unit 50b calculates a predicted lane departure time t_tlc that deviates from the lane in the current traveling state by, for example, the following equation (10).

t_tlc=(L−y_offset)/(V・sin(θyaw) …(10)
ここで、y_offsetは、例えば、路面カント、道路幅、車線曲率等の条件により、予め実験・計算等により設定しておいたマップやテーブルを参照して設定する値である。そして、車線逸脱防止目標旋回量(本実施の形態では、車線逸脱防止目標ヨーレート)γtLを、例えば、以下の(11)式により算出する。
t_tlc = (L−y_offset) / (V · sin (θyaw) (10)
Here, y_offset is a value set by referring to a map or table that has been set in advance through experiments and calculations, for example, under conditions such as road surface cant, road width, and lane curvature. Then, the lane departure prevention target turning amount (in this embodiment, the lane departure prevention target yaw rate) γtL is calculated by, for example, the following equation (11).

γtL=−θyaw/t_tlc …(11)
尚、車線が認識されていない場合は、車線逸脱防止目標ヨーレートγtLを0(γtL=0)に設定する。
γtL = −θyaw / t_tlc (11)
If the lane is not recognized, the lane departure prevention target yaw rate γtL is set to 0 (γtL = 0).

逸脱防止制御部50bは、上述の(11)式により算出される車線逸脱防止目標ヨーレートγtLを基に、例えば、以下の(12)式により、目標操舵トルクTδを算出し、操舵制御部40に出力する。   The departure prevention control unit 50b calculates the target steering torque Tδ by, for example, the following equation (12) based on the lane departure prevention target yaw rate γtL calculated by the above equation (11), and sends it to the steering control unit 40. Output.

Tδ=Gtff・γtL+Gtfbp・(γtL−γ)+Gtfbd・d(γtL−γ)/dt
+Gtfbi・∫(γtL−γ)dt …(12)
ここで、Gtffは予め実験、計算等により設定しておいたフィードフォワードゲイン、Gtfbp、Gtfbd、Gtfbiはそれぞれ予め実験、計算等により設定しておいたフィードバックゲインである。
Tδ = Gtff · γtL + Gtfbp · (γtL−γ) + Gtfbd · d (γtL−γ) / dt
+ Gtfbi · ∫ (γtL−γ) dt (12)
Here, Gtff is a feed forward gain set in advance by experiment, calculation, etc., and Gtfbp, Gtfbd, Gtfbi are feedback gains set in advance by experiment, calculation, etc.

このように、逸脱防止制御部50bは、逸脱防止制御手段として設けられている。   Thus, the departure prevention control unit 50b is provided as departure prevention control means.

車線追従制御部50cは、走行情報取得部50aからの情報を基に、自車両1を目標コース(本実施の形態では車線中央)に沿って走行させるために自車両1に付加するヨーモーメントMzを、例えば、以下の(13)式により算出する。   Based on the information from the travel information acquisition unit 50a, the lane tracking control unit 50c adds the yaw moment Mz added to the host vehicle 1 to drive the host vehicle 1 along the target course (lane center in the present embodiment). Is calculated by the following equation (13), for example.

Mz=Mzy+Mziy+Mzθ …(13)
ここで、Mzyは、予め設定する前方注視点(位置)における自車両の幅方向における目標コースと自車位置とのズレ量Δyに応じて設定される付加ヨーモーメントであり、例えば、予め実験、計算等により図5(a)のマップに示す特性で設定される。また、Mziyは、自車両に作用する外乱により生じる自車両の幅方向における目標コースと自車位置とのズレ量に応じて設定される付加ヨーモーメントであり、例えば、予め実験、計算等により図5(b)のマップに示す特性で設定される。尚、本実施の形態では、自車両に作用する外乱により生じる自車両の幅方向における目標コースと自車位置とのズレ量は、例えば、「∫(Δy)dt」のΔyを積分することにより算出する。更に、Mzθは、目標コースの進行方向と自車両の進行方向の角度のズレ量θyawに応じて設定される付加ヨーモーメントであり、例えば、予め実験、計算等により図5(c)のマップに示す特性で設定される。
Mz = Mzy + Mziy + Mzθ (13)
Here, Mzy is an additional yaw moment that is set according to a deviation amount Δy between the target course and the vehicle position in the width direction of the host vehicle at a preset forward gazing point (position). It is set with the characteristics shown in the map of FIG. Mziy is an additional yaw moment that is set in accordance with the amount of deviation between the target course and the vehicle position in the width direction of the host vehicle caused by a disturbance acting on the host vehicle. It is set with the characteristics shown in the map of 5 (b). In the present embodiment, the amount of deviation between the target course and the vehicle position in the width direction of the host vehicle caused by disturbance acting on the host vehicle is obtained by, for example, integrating Δy of “∫ (Δy) dt”. calculate. Further, Mzθ is an additional yaw moment set according to the amount of deviation θyaw of the angle between the traveling direction of the target course and the traveling direction of the host vehicle. For example, Mzθ is shown in the map of FIG. It is set with the characteristics shown.

そして、車線追従制御部50cは、前述の(13)式で算出した自車両1に付加するヨーモーメントMz(反時計回りを「+」として)に基づいて、例えば、以下の(14)、(15)式により、第3モータ18に発生させるモータトルクTrlと、第2モータ17に発生させるモータトルクTrrを算出し、モータトルクTrlは第3モータ制御部27に、モータトルクTrrは第2モータ制御部26に出力する。   Then, the lane tracking control unit 50c, for example, based on the yaw moment Mz added to the host vehicle 1 calculated by the above equation (13) (counterclockwise as “+”), for example, the following (14), ( 15), the motor torque Trl generated by the third motor 18 and the motor torque Trr generated by the second motor 17 are calculated. The motor torque Trl is calculated by the third motor control unit 27, and the motor torque Trr is calculated by the second motor. Output to the control unit 26.

Trl=−(rt/d)・Mz …(14)
Trr=+(rt/d)・Mz …(15)
ここで、rtはタイヤ半径、dはトレッドである。
Trl = − (rt / d) · Mz (14)
Trr = + (rt / d) · Mz (15)
Here, rt is a tire radius and d is a tread.

このように、車線追従制御部50cは、追従走行制御手段として設けられている。そして、車線追従制御部50cによる制御量(ヨーモーメントMz)は、前述の(13)式からも明らかなように、予め設定する前方注視点(位置)における自車両の幅方向における目標コースと自車位置とのズレ量Δy、自車両に作用する外乱により生じる自車両の幅方向における目標コースと自車位置とのズレ量「∫(Δy)dt」、及び、目標コースの進行方向と自車両の進行方向の角度のズレ量θyawに応じたフィードバック制御により算出される制御量となっている。   Thus, the lane tracking control unit 50c is provided as a tracking traveling control unit. The control amount (yaw moment Mz) by the lane follow-up control unit 50c is the same as the target course in the width direction of the host vehicle at the preset forward gazing point (position), as is apparent from the above-described equation (13). A deviation amount Δy from the vehicle position, a deviation amount “∫ (Δy) dt” between the target course and the vehicle position in the width direction of the own vehicle caused by a disturbance acting on the own vehicle, and a traveling direction of the target course and the own vehicle This is a control amount calculated by feedback control according to the angle deviation amount θyaw of the traveling direction.

このように、本発明の実施の形態によれば、目標コースが設定される車線からの逸脱を防止する逸脱防止制御の制御量(目標操舵トルクTδ)を算出し、目標操舵トルクTδは操舵制御部40に出力して操舵制御する。また、目標コースに沿って自車両を追従走行させる追従走行制御の制御量(自車両に付加するヨーモーメントMz)を算出し、この付加ヨーモーメントMzに基づき第2モータ17に発生させるモータトルクTrrと第3モータ18に発生させるモータトルクTrlを算出して第2モータ制御部26と第3モータ制御部27に出力する。   As described above, according to the embodiment of the present invention, the control amount (target steering torque Tδ) of the departure prevention control for preventing the departure from the lane where the target course is set is calculated, and the target steering torque Tδ is the steering control. It outputs to the part 40 and performs steering control. Also, a control amount (yaw moment Mz to be added to the host vehicle) for tracking the host vehicle to follow the host vehicle along the target course is calculated, and the motor torque Trr generated by the second motor 17 based on the additional yaw moment Mz. The motor torque Trl generated by the third motor 18 is calculated and output to the second motor control unit 26 and the third motor control unit 27.

以上の自動運転制御により、車線追従制御から、逸脱防止制御を経て、再び車線追従制御に戻る制御の一例を図6で説明する。   An example of the control that returns from the lane tracking control to the lane tracking control again through the departure prevention control by the above automatic driving control will be described with reference to FIG.

まず、車輪の制駆動力配分制御により自車両にヨーモーメントMzを付加して目標コースに沿って走行するように車線追従制御が実行されているQ1の時点で、図6中の矢印で示すような車線からの逸脱が予測されると、車線からの逸脱を防止する逸脱回避経路の車線逸脱防止目標ヨーレートγtLが算出されて、該車線逸脱防止目標ヨーレートγtLに応じた目標操舵トルクTδで、Q2点に示すように、目標操舵トルクTδで操舵制御される。このため、ドライバがステアリングホイールを保持していない自動運転の状態で、車輪の制駆動力配分制御により車両にヨーモーメントを付加している際に、例えば、急カーブ等を通過しようとする場合、車輪の制駆動力配分制御のみでは車両に付加するヨーモーメントが不足し、目標コースに沿って追従走行することが困難になり、車線からの逸脱が予測されるような状況においも、自動的操舵制御が行われ、車線からの逸脱が確実に防止される。また、ステアリングホイールの回転により、ドライバは操舵の必要性を知ることができ、ドライバに操舵を促すことができる。その後、車線からの逸脱が防止され、ドライバの操舵が行われて図6中のQ3点、Q4点と進むと、逸脱防止による操舵制御は小さくなり、車輪の制駆動力配分制御により自車両にヨーモーメントMzを付加して目標コースに沿って走行するように車線追従制御が実行され、ドライバが違和感の無い走行をスムーズに行うことができる。   First, as indicated by the arrows in FIG. 6, at the time of Q1, when the lane following control is executed so that the yaw moment Mz is added to the host vehicle by the wheel braking / driving force distribution control and the vehicle follows the target course. When a departure from a lane is predicted, a lane departure prevention target yaw rate γtL of a departure avoidance route that prevents the departure from the lane is calculated, and a target steering torque Tδ corresponding to the lane departure prevention target yaw rate γtL is calculated as Q2. As indicated by the points, steering control is performed with the target steering torque Tδ. For this reason, when the yaw moment is being added to the vehicle by the braking / driving force distribution control of the wheel in the automatic driving state where the driver does not hold the steering wheel, for example, when trying to pass a sharp curve, Even if the wheel braking / driving force distribution control alone is not sufficient, the yaw moment added to the vehicle will be insufficient, making it difficult to follow the target course and driving away from the lane. Control is performed and departure from the lane is reliably prevented. Further, the rotation of the steering wheel allows the driver to know the necessity of steering, and can prompt the driver to steer. After that, when deviation from the lane is prevented and the driver is steered and proceeds to points Q3 and Q4 in FIG. 6, the steering control by deviation prevention becomes small, and the vehicle is controlled by the braking / driving force distribution control of the wheels. Lane follow-up control is executed so as to travel along the target course with the yaw moment Mz added, and the driver can smoothly travel without feeling uncomfortable.

尚、本実施の形態では、エンジンと3つの電動モータを備えたハイブリッド車を例に説明したが、これに限ること無く、例えば、4輪にインホイールモータを備えた電動自動車や、他の形式のハイブリッド車等であっても、左右輪間の制駆動力差により車両にヨーモーメントを付加することができる車両であれば、本発明を適用できることは言うまでも無い。   In the present embodiment, a hybrid vehicle including an engine and three electric motors has been described as an example. However, the present invention is not limited to this, and for example, an electric vehicle including an in-wheel motor on four wheels, and other types. It goes without saying that the present invention can be applied to any hybrid vehicle or the like as long as the vehicle can add a yaw moment to the vehicle due to a difference in braking / driving force between the left and right wheels.

1 自車両
2 駆動系
3 操舵系
11 エンジン
12 クラッチ機構
13 第1モータ
14 変速機
15 減速装置
16fl、16fr 駆動輪
17 第2モータ
18 第3モータ
19rl、19rr 減速装置
20rl、20rr 駆動輪
21 バッテリ装置
22 エンジン制御部
23 変速機制御部
24 バッテリ制御部
25 第1モータ制御部
26 第2モータ制御部(ヨーモーメント付加制御手段)
27 第3モータ制御部(ヨーモーメント付加制御手段)
31 ステアリングホイール
31a ステアリングシャフト
32 ジョイント部
34 ステアリングギヤボックス
35 ピニオン軸
38fl、38fr アクスルハウジング
39 電動パワーステアリング機構
40 操舵制御部(操舵制御手段)
41 前方環境認識装置
42 ナビゲーションシステム
43 車速センサ
44 操舵角センサ
45 ヨーレートセンサ
50 制御ユニット
50a 走行情報取得部
50b 逸脱防止制御部(逸脱防止制御手段)
50c 車線追従制御部(追従走行制御手段)
DESCRIPTION OF SYMBOLS 1 Own vehicle 2 Drive system 3 Steering system 11 Engine 12 Clutch mechanism 13 1st motor 14 Transmission 15 Deceleration device 16fl, 16fr Drive wheel 17 2nd motor 18 3rd motor 19rl, 19rr Deceleration device 20rl, 20rr Drive wheel 21 Battery device 22 engine control unit 23 transmission control unit 24 battery control unit 25 first motor control unit 26 second motor control unit (yaw moment addition control means)
27 Third motor control section (yaw moment addition control means)
31 Steering wheel 31a Steering shaft 32 Joint part 34 Steering gear box 35 Pinion shaft 38fl, 38fr Axle housing 39 Electric power steering mechanism 40 Steering control part (steering control means)
DESCRIPTION OF SYMBOLS 41 Front environment recognition apparatus 42 Navigation system 43 Vehicle speed sensor 44 Steering angle sensor 45 Yaw rate sensor 50 Control unit 50a Travel information acquisition part 50b Deviation prevention control part (deviation prevention control means)
50c Lane tracking control unit (tracking control means)

Claims (2)

自車両の走行環境情報に基づいて目標コースが予め設定される車線からの自車両の逸脱を防止する逸脱防止制御手段と、
前記目標コースに沿って自車両を追従走行させる追従走行制御手段と、
前記逸脱防止制御手段からの制御量に基づいて操舵制御する操舵制御手段と、
前記追従走行制御手段からの制御量に基づいて車輪の制駆動力配分制御により車両にヨーモーメントを付加するヨーモーメント付加制御手段と、
を備えたことを特徴とする車両の走行制御装置。
Deviation prevention control means for preventing deviation of the host vehicle from the lane in which the target course is preset based on the traveling environment information of the host vehicle;
Follow-up running control means for causing the host vehicle to follow up along the target course;
Steering control means for performing steering control based on a control amount from the departure prevention control means;
Yaw moment addition control means for adding a yaw moment to the vehicle by braking / driving force distribution control of the wheels based on the control amount from the following traveling control means;
A travel control device for a vehicle, comprising:
前記追従走行制御手段による前記制御量は、自車両の幅方向における前記目標コースと自車位置とのズレ量と前記目標コースの進行方向と自車両の進行方向の角度のズレ量の少なくとも一方が無くなるようにフィードバック制御により算出される制御量であることを特徴とする請求項1記載の車両の走行制御装置。   The control amount by the following traveling control means is at least one of a deviation amount between the target course and the vehicle position in the width direction of the own vehicle, and an angle deviation amount between the traveling direction of the target course and the traveling direction of the own vehicle. 2. The vehicle travel control device according to claim 1, wherein the control amount is calculated by feedback control so as to be eliminated.
JP2017067544A 2017-03-30 2017-03-30 Vehicle travel control device Active JP6898636B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017067544A JP6898636B2 (en) 2017-03-30 2017-03-30 Vehicle travel control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017067544A JP6898636B2 (en) 2017-03-30 2017-03-30 Vehicle travel control device

Publications (2)

Publication Number Publication Date
JP2018167733A true JP2018167733A (en) 2018-11-01
JP6898636B2 JP6898636B2 (en) 2021-07-07

Family

ID=64019709

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017067544A Active JP6898636B2 (en) 2017-03-30 2017-03-30 Vehicle travel control device

Country Status (1)

Country Link
JP (1) JP6898636B2 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109808687A (en) * 2019-01-17 2019-05-28 福瑞泰克智能系统有限公司 A kind of driving assistance method, device and equipment
CN111284486A (en) * 2018-12-06 2020-06-16 株式会社斯巴鲁 Vehicle travel control device
CN113727897A (en) * 2019-04-25 2021-11-30 株式会社爱德克斯 Vehicle control device
WO2023067802A1 (en) * 2021-10-22 2023-04-27 日立Astemo株式会社 Driving force control device and vehicle

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003327151A (en) * 2002-05-14 2003-11-19 Mitsubishi Electric Corp Support system for keeping lane for vehicle
US20130096767A1 (en) * 2011-10-17 2013-04-18 Robert Bosch Gmbh Method and device for lane keeping assistance regulation
JP2015189409A (en) * 2014-03-28 2015-11-02 富士重工業株式会社 Lane deviation prevention control device of vehicle

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003327151A (en) * 2002-05-14 2003-11-19 Mitsubishi Electric Corp Support system for keeping lane for vehicle
US20130096767A1 (en) * 2011-10-17 2013-04-18 Robert Bosch Gmbh Method and device for lane keeping assistance regulation
JP2015189409A (en) * 2014-03-28 2015-11-02 富士重工業株式会社 Lane deviation prevention control device of vehicle

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111284486A (en) * 2018-12-06 2020-06-16 株式会社斯巴鲁 Vehicle travel control device
CN109808687A (en) * 2019-01-17 2019-05-28 福瑞泰克智能系统有限公司 A kind of driving assistance method, device and equipment
CN109808687B (en) * 2019-01-17 2021-09-21 福瑞泰克智能系统有限公司 Driving assistance method, device and equipment
CN113727897A (en) * 2019-04-25 2021-11-30 株式会社爱德克斯 Vehicle control device
US12078494B2 (en) 2019-04-25 2024-09-03 Advics Co., Ltd. Vehicle control device
WO2023067802A1 (en) * 2021-10-22 2023-04-27 日立Astemo株式会社 Driving force control device and vehicle

Also Published As

Publication number Publication date
JP6898636B2 (en) 2021-07-07

Similar Documents

Publication Publication Date Title
JP6573643B2 (en) Vehicle travel control device
JP6055525B1 (en) Vehicle travel control device
US10266174B2 (en) Travel control device for vehicle
JP6831734B2 (en) Vehicle travel control device
JP6025273B2 (en) Vehicle travel control device
CN104742959B (en) The track of vehicle keeps control device
JP6055528B1 (en) Vehicle steering control device
JP6842339B2 (en) Vehicle travel control device
JP7185511B2 (en) Vehicle travel control device
JP6898636B2 (en) Vehicle travel control device
JP6774259B2 (en) Vehicle travel control device
JP6986463B2 (en) Driving support device, driving support method and driving support system
JP6579699B2 (en) Vehicle travel control device
JP6027659B1 (en) Vehicle travel control device
JP2018024345A (en) Travelling control device of vehicle
JP6722078B2 (en) Vehicle steering control device
JP2020125058A (en) Vehicular turning-attitude control method and turning-attitude control apparatus
CN111204344B (en) Vehicle travel control device
JP6803285B2 (en) Vehicle travel control device
JP6595867B2 (en) Vehicle automatic operation control device
JP6706166B2 (en) Vehicle running control device
JP2017061265A (en) Travel control device for vehicle
JP6496588B2 (en) Vehicle behavior control device
JP7245069B2 (en) Vehicle travel control device
JP6654962B2 (en) Vehicle steering control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20191211

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20191211

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201028

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201104

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201215

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210202

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210317

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210604

R150 Certificate of patent or registration of utility model

Ref document number: 6898636

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250