JP6745087B2 - Lane maintenance support device and lane maintenance support method - Google Patents

Lane maintenance support device and lane maintenance support method Download PDF

Info

Publication number
JP6745087B2
JP6745087B2 JP2014245842A JP2014245842A JP6745087B2 JP 6745087 B2 JP6745087 B2 JP 6745087B2 JP 2014245842 A JP2014245842 A JP 2014245842A JP 2014245842 A JP2014245842 A JP 2014245842A JP 6745087 B2 JP6745087 B2 JP 6745087B2
Authority
JP
Japan
Prior art keywords
steering
reaction force
steering reaction
value
torque
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.)
Active
Application number
JP2014245842A
Other languages
Japanese (ja)
Other versions
JP2016107750A (en
Inventor
裕也 武田
裕也 武田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan 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 Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2014245842A priority Critical patent/JP6745087B2/en
Publication of JP2016107750A publication Critical patent/JP2016107750A/en
Application granted granted Critical
Publication of JP6745087B2 publication Critical patent/JP6745087B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Steering Control In Accordance With Driving Conditions (AREA)

Description

本発明は、車両の車線維持制御を行う車線維持支援装置及び車線維持支援方法に関する。 The present invention relates to a lane keeping assist device and a lane keeping assist method for performing lane keeping control of a vehicle.

車両の車線維持支援装置として、例えば特許文献1に記載の技術がある。
特許文献1には、運転者からステアリングホイールに入力された操舵トルクの方向に応じてアシストトルクを付与する電動パワーステアリング(EPS)システムが開示されている。
As a lane keeping assist device for a vehicle, for example, there is a technique described in Patent Document 1.
Patent Document 1 discloses an electric power steering (EPS) system that applies an assist torque according to a direction of a steering torque input to a steering wheel by a driver.

特開2010−188825号公報JP, 2010-188825, A

車線維持支援装置では、高い車線追従性能と、運転者への十分な反力伝達性能との両立が求められるが、ステアリングホイールと車輪とが機械的に連結している電動パワーステアリングシステムでは、車線追従性能を高めた場合、ステアリングホイールに付与する反力は車輪の転舵角制御に伴って自動的に決まってしまい、2つの性能を満足することが困難であった。 The lane keeping assist device is required to have both high lane following performance and sufficient reaction force transmission performance to the driver, but in the electric power steering system where the steering wheel and wheels are mechanically connected, When the follow-up performance is enhanced, the reaction force applied to the steering wheel is automatically determined in accordance with the steering angle control of the wheel, and it is difficult to satisfy the two performances.

ステアリングホイールと車輪とが機械的に切り離されたステアバイワイヤ(SBW)システムを用いれば、反力と転舵角とを別々に制御できるようになることから、上記の問題は解決する。しかし、反力を高めたときに、過剰な0反力により運転者の操舵入力を超えてステアリングホイールが回ってしまうと、それに応じて車輪の転舵角が変化して車両の挙動に影響するため、反力制御の自由度は制限される。
本発明の目的は、ステアバイワイヤシステムのようにステアリングホイールと車輪とが機械的に切り離された車両において、操舵入力の切り増し又は切り戻しに応じて反力制御を切り替える車線維持支援装置及び車線維持支援方法を提供することである。
The above problem is solved by using a steer-by-wire (SBW) system in which the steering wheel and the wheels are mechanically separated from each other, since the reaction force and the turning angle can be controlled separately. However, when the reaction force is increased, if the steering wheel turns beyond the steering input of the driver due to excessive zero reaction force, the steering angle of the wheels changes accordingly, which affects the behavior of the vehicle. Therefore, the degree of freedom of reaction force control is limited.
An object of the present invention is to provide a lane keeping assist device and a lane keeping assist device for switching reaction force control in accordance with steering input increase or return in a vehicle in which a steering wheel and wheels are mechanically separated from each other, such as a steer-by-wire system. It is to provide a support method.

上記の課題を解決するため、本発明の一態様に係る車線維持支援装置は、運転者の操舵入力を受けるステアリングホイールと車両の向きを変える転舵輪とが機械的に切り離された車両において、車両の走行状況に応じた操舵反力トルクをステアリングホイールに付与することで、車両の車線維持制御を行う。このとき、車両の走行状況に応じた操舵反力トルクを求める処理として、車両が車線の逸脱方向に近づく際に操舵反力トルクを求める第1処理と、車両が車線の逸脱回避方向に近づく際に操舵反力トルクを求める第2処理と、を別々に実施可能となっている。また、車両の走行状況が同一のとき、第1処理により求められる操舵反力トルクのほうが、第2処理により求められる操舵反力トルクよりも大きい。 In order to solve the above problems, a lane keeping assist device according to an aspect of the present invention is a vehicle in which a steering wheel that receives a steering input from a driver and a steered wheel that changes the direction of the vehicle are mechanically separated. The lane keeping control of the vehicle is performed by applying a steering reaction force torque to the steering wheel according to the traveling state of the vehicle. At this time, as the processing for obtaining the steering reaction force torque according to the traveling state of the vehicle, the first processing for obtaining the steering reaction force torque when the vehicle approaches the departure direction of the lane and the process for obtaining the steering reaction torque when the vehicle approaches the departure direction of the lane The second process for obtaining the steering reaction force torque can be separately performed. Further, when the traveling conditions of the vehicle are the same, the steering reaction force torque obtained by the first process is larger than the steering reaction force torque obtained by the second process.

本発明の一態様によれば、操舵入力の切り増し側(逸脱側)での反力と、切り戻し側(逸脱回避側)での反力とを別々に求めることが可能であり、操舵入力の切り増し又は切り戻しに応じて反力制御を切り替えることができる。 According to one aspect of the present invention, it is possible to separately obtain the reaction force on the steering input side for increasing the steering input (deviation side) and the reaction force on the steering return side (deviation avoiding side). The reaction force control can be switched according to the increase or the return of the cutting.

車線維持支援装置を搭載した車両Aの操舵系の構成例を表すブロック図である。It is a block diagram showing an example of composition of a steering system of vehicles A carrying a lane maintenance assistance device. 操舵反力制御部の構成例を表すブロック図である。It is a block diagram showing an example of composition of a steering reaction force control part. 横力オフセット部の構成例を表すブロック図である。It is a block diagram showing an example of composition of a lateral force offset part. 操舵反力オフセット部の構成例を表すブロック図である。It is a block diagram showing an example of composition of a steering reaction force offset part. 逸脱余裕時間に応じた反力演算部の構成例を表すブロック図である。It is a block diagram showing an example of composition of a reaction force operation part according to departure margin time. 横位置に応じた反力演算部の構成例を表すブロック図である。It is a block diagram showing an example of composition of a reaction force operation part according to a lateral position. 車線維持制御部の構成例を表すブロック図である。It is a block diagram showing an example of composition of a lane maintenance control part. 補正操舵角の設定に関するフローチャートである。It is a flow chart about setting of a correction steering angle. 現在操舵角、補正操舵角、及び無効操舵角の関係を示すグラフである。It is a graph which shows the relationship of a present steering angle, a correction steering angle, and an invalid steering angle. ラッチ操舵角の更新に関するフローチャートである。It is a flowchart regarding the update of the latch steering angle. ラッチ操舵角の更新における左方向対応処理に関するフローチャートである。It is a flow chart about processing corresponding to the left in updating a latch steering angle. ラッチ操舵角の更新における右方向対応処理に関するフローチャートである。It is a flowchart regarding the right handling process in updating the latch steering angle. 切り替えゲイン(切り増しゲイン及び切り戻しゲイン)の演算に関するフローチャートである。It is a flow chart regarding calculation of switching gain (additional gain and return gain). 切り替えゲインの適用に関するフローチャートである。It is a flowchart regarding application of a switching gain. 車両が左方向の車線端部に寄っている場合の逸脱余裕時間−反力変換マップの説明図である。It is explanatory drawing of the deviation margin time-reaction force conversion map when a vehicle is approaching the left lane edge part. 車両が右方向の車線端部に寄っている場合の逸脱余裕時間−反力変換マップの説明図である。It is explanatory drawing of the deviation margin time-reaction force conversion map when a vehicle is approaching the right lane edge part. 車両が左方向の車線端部に寄っている場合の横位置偏差−反力変換マップの説明図である。It is explanatory drawing of the lateral position deviation-reaction force conversion map when a vehicle is approaching the left lane edge part. 車両が右方向の車線端部に寄っている場合の横位置偏差−反力変換マップの説明図である。It is explanatory drawing of the lateral position deviation-reaction force conversion map when a vehicle is leaning to the right lane edge. 転舵制御部の構成例を表すブロック図である。It is a block diagram showing the example of composition of a steering control part. 外乱抑制指令転舵角演算部の構成例を表すブロック図である。It is a block diagram showing the example of composition of a disturbance suppression command steering angle operation part. ヨー角に応じた反発力演算部の構成例を表すブロック図である。It is a block diagram showing the structural example of the repulsion force calculation part according to a yaw angle. 横位置に応じた反発力演算部の構成例を表すブロック図である。It is a block diagram showing an example of composition of a repulsive force operation part according to a horizontal position. 横位置フィードバック制御の実行領域を表す図である。It is a figure showing the execution area of lateral position feedback control.

<実施形態>
以下に、本発明の実施形態について添付図面を参照して説明する。
(構成)
図1は、本実施形態に係る車線維持支援装置を搭載した車両Aの操舵系の構成例を表すブロック図である。
図1に示すように、車両Aは、操舵部1と、転舵部2と、バックアップクラッチ3と、SBWコントローラ4とを備える。車両Aは、運転者の操舵入力を受ける操舵部1と、転舵輪である左右前輪5FL、5FRを転舵する転舵部2とが機械的に切り離されたステアバイワイヤ(SBW)システムを採用している。
<Embodiment>
Embodiments of the present invention will be described below with reference to the accompanying drawings.
(Constitution)
FIG. 1 is a block diagram showing a configuration example of a steering system of a vehicle A equipped with a lane keeping assist device according to the present embodiment.
As shown in FIG. 1, the vehicle A includes a steering unit 1, a steering unit 2, a backup clutch 3, and an SBW controller 4. The vehicle A employs a steer-by-wire (SBW) system in which a steering unit 1 that receives a steering input from a driver and a steering unit 2 that steers the left and right front wheels 5FL and 5FR are mechanically separated. ing.

操舵部1は、ステアリングホイール1aと、コラムシャフト1bと、反力モータ1cと、操舵角センサ1dと、トルクセンサ1eを備える。
ステアリングホイール1aは、運転者の操舵入力を受けて回転する。
コラムシャフト1bは、ステアリングホイール1aと一体に回転する。
反力モータ1cは、出力軸がコラムシャフト1bと同軸であり、SBWコントローラ4からの指令(後述する反力モータ用電流ドライバ9aが出力した指令電流)に応じて、ステアリングホイール1aに付与する操舵反力トルクをコラムシャフト1bに出力する。例えば、反力モータ1cは、ブラシレスモータ等である。
The steering unit 1 includes a steering wheel 1a, a column shaft 1b, a reaction force motor 1c, a steering angle sensor 1d, and a torque sensor 1e.
The steering wheel 1a rotates in response to a steering input from the driver.
The column shaft 1b rotates integrally with the steering wheel 1a.
The reaction motor 1c has an output shaft coaxial with the column shaft 1b, and steering applied to the steering wheel 1a according to a command from the SBW controller 4 (a command current output by a reaction motor motor current driver 9a described later). The reaction torque is output to the column shaft 1b. For example, the reaction force motor 1c is a brushless motor or the like.

操舵角センサ1dは、コラムシャフト1bの回転角、すなわち、ステアリングホイール1aの操舵角(ハンドル角度)を検出する。そして、操舵角センサ1dは、検出結果を後述するSBWコントローラ4に出力する。
トルクセンサ1eは、コラムシャフト1bに掛かる回転方向の力である操舵トルクを検出する。回転方向は操舵トルクの符号(±)により表現される。そして、トルクセンサ1eは、検出結果を後述するSBWコントローラ4に出力する。
The steering angle sensor 1d detects the rotation angle of the column shaft 1b, that is, the steering angle (steering wheel angle) of the steering wheel 1a. Then, the steering angle sensor 1d outputs the detection result to the SBW controller 4, which will be described later.
The torque sensor 1e detects a steering torque, which is a force applied to the column shaft 1b in the rotation direction. The rotation direction is represented by the sign (±) of the steering torque. Then, the torque sensor 1e outputs the detection result to the SBW controller 4 described later.

転舵部2は、ピニオンシャフト2aと、ステアリングギア2bと、転舵モータ2cと、転舵角センサ2dと、ラック2fと、ラックギア2eとを備える。
ステアリングギア2bは、ピニオンシャフト2aの回転に応じて、左右前輪5FL、5FRを転舵する。ステアリングギア2bとしては、例えば、ラック・アンド・ピニオン式のステアリングギア等を採用できる。
転舵モータ2cは、出力軸が減速機を介してラックギア2eと接続され、SBWコントローラ4からの指令(後述する転舵モータ用電流ドライバ9bが出力した指令電流)に応じて、ラック2fに左右前輪5FL、5FRを転舵するための転舵トルクを出力する。例えば、転舵モータ2cは、ブラシレスモータ等である。
The steered portion 2 includes a pinion shaft 2a, a steering gear 2b, a steered motor 2c, a steered angle sensor 2d, a rack 2f, and a rack gear 2e.
The steering gear 2b steers the left and right front wheels 5FL, 5FR according to the rotation of the pinion shaft 2a. As the steering gear 2b, for example, a rack and pinion type steering gear or the like can be adopted.
The steering motor 2c has an output shaft connected to the rack gear 2e via a speed reducer, and the steering motor 2c is moved to the left or right of the rack 2f according to a command from the SBW controller 4 (a command current output from a steering motor current driver 9b described later). The steering torque for steering the front wheels 5FL, 5FR is output. For example, the steering motor 2c is a brushless motor or the like.

転舵角センサ2dは、転舵モータ2cの回転角を検出する。ここで、転舵モータ2cの回転角と左右前輪5FL、5FRの転舵角(タイヤ角度)との間には、一意に定まる相関関係がある。それゆえ、左右前輪5FL、5FRの転舵角は、転舵モータ2cの回転角から検出できる。以下では特に記載しない限り、左右前輪5FL、5FRの転舵角は、転舵モータ2cの回転角から算出されたものとする。
バックアップクラッチ3は、コラムシャフト1bとピニオンシャフト2aとの間に設けられている。そして、バックアップクラッチ3は、解放状態になると操舵部1と転舵部2とを機械的に切り離し、締結状態になると操舵部1と転舵部2とを機械的に接続する。
The steering angle sensor 2d detects the rotation angle of the steering motor 2c. Here, there is a uniquely determined correlation between the rotation angle of the steering motor 2c and the steering angles (tire angles) of the left and right front wheels 5FL, 5FR. Therefore, the turning angles of the left and right front wheels 5FL, 5FR can be detected from the rotation angle of the turning motor 2c. Unless otherwise specified below, it is assumed that the turning angles of the left and right front wheels 5FL and 5FR are calculated from the rotation angle of the turning motor 2c.
The backup clutch 3 is provided between the column shaft 1b and the pinion shaft 2a. The backup clutch 3 mechanically disconnects the steering unit 1 and the steering unit 2 when it is in the disengaged state, and mechanically connects the steering unit 1 and the steering unit 2 when it is in the engaged state.

また、車両Aは、カメラ6と、各種センサ7と、ナビゲーションシステム8と、電流ドライバ9とを備える。
カメラ6は、車両A前方の走行路の映像を検出する。続いて、カメラ6は、検出結果をSBWコントローラ4に出力する。
各種センサ7は、車速センサ7aと、加速度センサ7bと、ペダル操作センサ7cとを含む。
車速センサ7aは、車両Aの車速を検出する。続いて、車速センサ7aは、検出結果をSBWコントローラ4に出力する。
加速度センサ7bは、車両Aの前後方向の加速度(前後加速度)、及び車両Aの左右方向の加速度(横加速度)を検出する。そして、加速度センサ7bは、検出結果をSBWコントローラ4に出力する。
ペダル操作センサ7cは、車両Aのアクセルペダルの操作量及びブレーキペダルの操作量(ペダル操作情報)を検出する。そして、ペダル操作センサ7cは、検出結果をSBWコントローラ4に出力する。
The vehicle A also includes a camera 6, various sensors 7, a navigation system 8, and a current driver 9.
The camera 6 detects an image of a traveling road in front of the vehicle A. Then, the camera 6 outputs the detection result to the SBW controller 4.
The various sensors 7 include a vehicle speed sensor 7a, an acceleration sensor 7b, and a pedal operation sensor 7c.
The vehicle speed sensor 7a detects the vehicle speed of the vehicle A. Then, the vehicle speed sensor 7a outputs the detection result to the SBW controller 4.
The acceleration sensor 7b detects the longitudinal acceleration (longitudinal acceleration) of the vehicle A and the lateral acceleration (lateral acceleration) of the vehicle A. Then, the acceleration sensor 7b outputs the detection result to the SBW controller 4.
The pedal operation sensor 7c detects the operation amount of the accelerator pedal and the operation amount of the brake pedal (pedal operation information) of the vehicle A. Then, the pedal operation sensor 7c outputs the detection result to the SBW controller 4.

ナビゲーションシステム8は、GPS(Global Positioning System)受信機、地図データベース、及び表示モニタを備える。そして、ナビゲーションシステム8は、GPS受信機及び地図データベースから車両Aの位置及び道路情報を取得する。続いて、ナビゲーションシステム8は、取得した車両Aの位置及び道路情報に基づいて経路探索を行う。続いて、ナビゲーションシステム8は、経路探索の結果を表示モニタに表示する。また、ナビゲーションシステム8は、取得した道路情報のうち、車両Aの走行路の道路情報をSBWコントローラ4に出力する。例えば、走行路の道路情報は、走行路の種別(高速道路、一般道)、及び現在の車両位置の走行路の車線幅(車線幅情報)等である。 The navigation system 8 includes a GPS (Global Positioning System) receiver, a map database, and a display monitor. Then, the navigation system 8 acquires the position and road information of the vehicle A from the GPS receiver and the map database. Then, the navigation system 8 performs a route search based on the acquired position of the vehicle A and road information. Then, the navigation system 8 displays the result of the route search on the display monitor. Further, the navigation system 8 outputs the road information of the traveling path of the vehicle A to the SBW controller 4 among the acquired road information. For example, the road information of the traveling road includes the type of traveling road (highway, general road), the lane width of the traveling road at the current vehicle position (lane width information), and the like.

電流ドライバ9は、反力モータ用電流ドライバ9aと、転舵モータ用電流ドライバ9bとを含む。
反力モータ用電流ドライバ9aは、反力モータ1cの電流値から推定される実操舵反力トルクを、SBWコントローラ4からの指令操舵反力トルクと一致させるトルクフィードバックにより、反力モータ1cへの指令電流を制御する。
転舵モータ用電流ドライバ9bは、転舵角センサ2dにより検出される実転舵角を、SBWコントローラ4からの指令転舵角と一致させる角度フィードバックにより、転舵モータ2cへの指令電流を制御する。
The current driver 9 includes a reaction force motor current driver 9a and a steering motor current driver 9b.
The reaction force motor current driver 9a sends the actual steering reaction force torque estimated from the current value of the reaction force motor 1c to the reaction force motor 1c by torque feedback that matches the command steering reaction force torque from the SBW controller 4. Control the command current.
The steering motor current driver 9b controls the command current to the steering motor 2c by angle feedback that matches the actual steering angle detected by the steering angle sensor 2d with the command steering angle from the SBW controller 4. To do.

SBWコントローラ4は、操舵角センサ1d、トルクセンサ1e、転舵角センサ2d、カメラ6、車速センサ7a、加速度センサ7b、ペダル操作センサ7c、及びナビゲーションシステム8が出力した検出結果(各種情報)を取得する。例えば、SBWコントローラ4は、電子制御装置(ECU)等である。
本実施形態では、SBWコントローラ4は、映像処理部4aと、車線維持制御部10と、操舵反力制御部20と、転舵制御部30とを備える。なお、実際には、映像処理部4a、車線維持制御部10、操舵反力制御部20、及び転舵制御部30はそれぞれ独立した回路又は装置であっても良い。
The SBW controller 4 outputs the detection results (various information) output by the steering angle sensor 1d, the torque sensor 1e, the turning angle sensor 2d, the camera 6, the vehicle speed sensor 7a, the acceleration sensor 7b, the pedal operation sensor 7c, and the navigation system 8. get. For example, the SBW controller 4 is an electronic control unit (ECU) or the like.
In the present embodiment, the SBW controller 4 includes an image processing unit 4a, a lane keeping control unit 10, a steering reaction force control unit 20, and a steering control unit 30. In reality, the image processing unit 4a, the lane keeping control unit 10, the steering reaction force control unit 20, and the steering control unit 30 may be independent circuits or devices.

映像処理部4aは、カメラ6から取得した車両A前方の走行路の映像に対して、エッジ抽出等の画像処理を行って走行車線の左右の走行路区分線(道路白線)を検出する。なお、実際には、道路白線は、黄線や破線でも良い。また、道路白線が存在しない又は検出し難い場合には、道路白線の代わりに、路肩や縁石、側溝、ガードレール(防護柵)、防音壁、擁壁、中央分離帯等を検出するようにしても良い。そして、映像処理部4aは、走行車線の左右の走行路区分線の検出結果(白線情報)を操舵反力制御部20及び転舵制御部30に出力する。 The image processing unit 4a performs image processing such as edge extraction on the image of the road ahead of the vehicle A acquired from the camera 6 to detect the road lane markings (road white lines) on the left and right of the lane. In practice, the road white line may be a yellow line or a broken line. Also, if there is no road white line or it is difficult to detect it, instead of the road white line, road shoulders, curbs, gutters, guardrails (guard fences), soundproof walls, retaining walls, median strips, etc. may be detected. good. Then, the image processing unit 4a outputs the detection result (white line information) of the lane markings on the left and right of the traveling lane to the steering reaction force control unit 20 and the steering control unit 30.

車線維持制御部10は、操舵角センサ1dが出力した検出結果(操舵角)に基づいて、後述する切り替えゲインを算出する。そして、車線維持制御部10は、算出結果(切り替えゲイン)を操舵反力制御部20に出力する。また、車線維持制御部10は、操舵反力制御部20が出力した指令(指令操舵反力トルク)を監視する。車線維持制御部10の詳細は後述する。 The lane keeping control unit 10 calculates a switching gain described later based on the detection result (steering angle) output by the steering angle sensor 1d. Then, the lane keeping control unit 10 outputs the calculation result (switching gain) to the steering reaction force control unit 20. Further, the lane keeping control unit 10 monitors the command (command steering reaction force torque) output by the steering reaction force control unit 20. Details of the lane keeping control unit 10 will be described later.

操舵反力制御部20は、取得した各種情報に基づいて、コラムシャフト1bに付与する操舵反力トルクを制御する指令(指令操舵反力トルク)を算出する。そして、操舵反力制御部20は、算出した指令操舵反力トルクを反力モータ用電流ドライバ9aに出力する。必要であれば、車線維持制御部10にも出力する。操舵反力制御部20の詳細は後述する。
転舵制御部30は、取得した各種情報に基づいて、左右前輪5FL、5FRの転舵角を制御する指令(指令転舵角)を算出する。そして、転舵制御部30は、算出した指令転舵角を転舵モータ用電流ドライバ9bに出力する。転舵制御部30の詳細は後述する。
The steering reaction force control unit 20 calculates a command (command steering reaction force torque) for controlling the steering reaction force torque applied to the column shaft 1b based on the acquired various information. Then, the steering reaction force control unit 20 outputs the calculated command steering reaction force torque to the reaction force motor current driver 9a. If necessary, it is also output to the lane keeping control unit 10. Details of the steering reaction force control unit 20 will be described later.
The steered control unit 30 calculates a command (command steered angle) for controlling the steered angles of the left and right front wheels 5FL, 5FR based on the acquired various information. Then, the steering control unit 30 outputs the calculated command steering angle to the steering motor current driver 9b. Details of the steering control unit 30 will be described later.

(操舵反力制御部20の構成)
図2は、操舵反力制御部20の構成例を表すブロック図である。
図2に示すように、操舵反力制御部20は、横力演算部21と、横力オフセット部22と、減算器20aと、SAT演算部23と、加算器20bと、操舵反力トルクオフセット部24と、加算器20cとを備える。
(Structure of Steering Reaction Force Control Unit 20)
FIG. 2 is a block diagram showing a configuration example of the steering reaction force control unit 20.
As shown in FIG. 2, the steering reaction force control unit 20 includes a lateral force calculation unit 21, a lateral force offset unit 22, a subtractor 20a, a SAT calculation unit 23, an adder 20b, and a steering reaction force torque offset. The unit 24 and the adder 20c are provided.

横力演算部21は、操舵角センサ1d及び車速センサ7aが出力した検出結果(操舵角、車速)に基づき、操舵角−横力変換マップ(MAP)を参照して、タイヤ横力を推定する。すなわち、横力演算部21は、操舵角及び車速と、操舵角−横力変換マップとに基づいて、タイヤ横力を推定する。例えば、操舵角−横力変換マップは、予め実験等で算出したコンベンショナルな操舵装置(操舵部1と転舵部2とが機械的に接続された操舵装置)における車速毎の操舵角とタイヤ横力との関係を表すマップである。操舵角−横力変換マップでは、操舵角が大きいほどタイヤ横力を大きな値とする。また、操舵角−横力変換マップでは、操舵角が小さいときは操舵角が大きいときよりも、操舵角の変化量に対するタイヤ横力の変化量を大きくする。更に、操舵角−横力変換マップでは、車速が高いほどタイヤ横力を小さな値とする。そして、横力演算部21は、算出結果を減算器20aに出力する。 The lateral force calculation unit 21 estimates the tire lateral force by referring to the steering angle-lateral force conversion map (MAP) based on the detection results (steering angle, vehicle speed) output by the steering angle sensor 1d and the vehicle speed sensor 7a. .. That is, the lateral force calculation unit 21 estimates the tire lateral force based on the steering angle and the vehicle speed and the steering angle-lateral force conversion map. For example, the steering angle-lateral force conversion map is a steering angle for each vehicle speed and a tire lateral force in a conventional steering device (a steering device in which the steering unit 1 and the steering unit 2 are mechanically connected) calculated in advance by experiments or the like. It is a map showing the relationship with power. In the steering angle-lateral force conversion map, the larger the steering angle, the larger the tire lateral force. Further, in the steering angle-lateral force conversion map, when the steering angle is small, the change amount of the tire lateral force with respect to the change amount of the steering angle is larger than when the steering angle is large. Further, in the steering angle-lateral force conversion map, the tire lateral force has a smaller value as the vehicle speed increases. Then, the lateral force calculation unit 21 outputs the calculation result to the subtractor 20a.

横力オフセット部22は、映像処理部4a及び車速センサ7aが出力した検出結果(白線情報、車速)に基づいて、横力オフセット量を算出する。例えば、横力オフセット量は、タイヤ横力によって発生するセルフアライニングトルク(SAT)に応じた操舵反力トルクを表す操舵反力特性をオフセットするためのオフセット量である。セルフアライニングトルクは、路面反力によって発生する、車輪が直進状態に戻ろうとする力(復元力)である。また、操舵反力特性は、後述するSAT演算部23で用いる横力−操舵反力変換マップである。横力オフセット量は、道路白線の曲率が大きいほどセルフアライニングトルクと同一符号方向へオフセットする。そして、横力オフセット部22は、算出結果を減算器20aに出力する。横力オフセット部22の詳細は後述する。 The lateral force offset unit 22 calculates the lateral force offset amount based on the detection results (white line information, vehicle speed) output by the image processing unit 4a and the vehicle speed sensor 7a. For example, the lateral force offset amount is an offset amount for offsetting the steering reaction force characteristic that represents the steering reaction force torque according to the self-aligning torque (SAT) generated by the tire lateral force. The self-aligning torque is a force (restoring force) generated by a road surface reaction force that causes the wheels to return to a straight traveling state. The steering reaction force characteristic is a lateral force-steering reaction force conversion map used in the SAT calculation unit 23 described later. The lateral force offset amount is offset in the same sign direction as the self-aligning torque as the curvature of the road white line is larger. Then, the lateral force offset unit 22 outputs the calculation result to the subtractor 20a. Details of the lateral force offset portion 22 will be described later.

減算器20aは、横力演算部21が出力した算出結果(タイヤ横力)から、横力オフセット部22が出力した算出結果(横力オフセット量)を減算する。これにより、減算器20aは、タイヤ横力によって発生するセルフアライニングトルクに応じた操舵反力トルクを表す操舵反力特性(後述する横力−操舵反力変換マップ)をセルフアライニングトルクと同一符号方向へオフセットできる。そして、減算器20aは、減算結果(オフセット後のタイヤ横力)をSAT演算部23に出力する。 The subtractor 20a subtracts the calculation result (lateral force offset amount) output by the lateral force offset unit 22 from the calculation result (tire lateral force) output by the lateral force calculation unit 21. As a result, the subtractor 20a makes the steering reaction force characteristic (a lateral force-steering reaction force conversion map described later) that represents the steering reaction force torque corresponding to the self-aligning torque generated by the tire lateral force the same as the self-aligning torque. Can be offset in the sign direction. Then, the subtractor 20a outputs the subtraction result (tire lateral force after offset) to the SAT calculation unit 23.

SAT演算部23は、減算器20aが出力した算出結果(オフセット後のタイヤ横力)に基づき、横力−操舵反力変換マップを参照して、オフセット後のタイヤ横力によって発生する操舵反力トルクを算出する。すなわち、SAT演算部23は、オフセット後のタイヤ横力と、横力−操舵反力変換マップとに基づいて、オフセット後のタイヤ横力によって発生する操舵反力トルクを算出する。そして、SAT演算部23は、算出結果(操舵反力トルク)を加算器20bに出力する。 The SAT calculation unit 23 refers to the lateral force-steering reaction force conversion map based on the calculation result (tire lateral force after offset) output by the subtractor 20a, and refers to the steering reaction force generated by the tire lateral force after offset. Calculate the torque. That is, the SAT calculator 23 calculates the steering reaction torque generated by the offset tire lateral force based on the offset tire lateral force and the lateral force-steering reaction force conversion map. Then, the SAT calculator 23 outputs the calculation result (steering reaction force torque) to the adder 20b.

例えば、横力−操舵反力変換マップは、予め実験等で算出したコンベンショナルな操舵装置におけるタイヤ横力と操舵力トルクとの関係を表すマップである。すなわち、横力−操舵反力変換マップは、コンベンショナルな操舵装置において、タイヤ横力によって発生するセルフアライニングトルクに応じた操舵反力トルクを表す操舵反力特性を模擬したものとする。横力−操舵反力変換マップでは、タイヤ横力が大きいほど操舵反力トルクを大きな値とする。また、横力−操舵反力変換マップでは、タイヤ横力が小さいときは大きいときよりも、タイヤ横力の変化量に対する操舵反力トルクの変化量を大きくする。更に、横力−操舵反力変換マップでは、車速が高いほど操舵反力トルクを小さな値とする。 For example, the lateral force-steering reaction force conversion map is a map that represents the relationship between the tire lateral force and the steering force torque in a conventional steering device that is calculated in advance by experiments or the like. That is, the lateral force-steering reaction force conversion map is assumed to simulate the steering reaction force characteristic that represents the steering reaction force torque according to the self-aligning torque generated by the tire lateral force in the conventional steering device. In the lateral force-steering reaction force conversion map, the larger the tire lateral force, the larger the steering reaction force torque. Further, in the lateral force-steering reaction force conversion map, when the tire lateral force is small, the change amount of the steering reaction force torque with respect to the change amount of the tire lateral force is made larger than when it is large. Furthermore, in the lateral force-steering reaction force conversion map, the steering reaction force torque has a smaller value as the vehicle speed increases.

加算器20bは、SAT演算部23が出力した算出結果(操舵反力トルク)に、ステアリング特性に応じた操舵反力トルク成分(ばね項、粘性項、慣性項)を加算する。ばね項は操舵角に比例する成分であり、操舵角に所定のゲインを乗じて算出する。粘性項は操舵角速度に比例する成分であり操舵角速度に所定のゲインを乗じて算出する。慣性項は操舵角加速度に比例する成分であり、操舵角加速度に所定のゲインを乗じて算出する。そして、加算器20bは、加算結果(操舵反力トルク+操舵反力トルク成分)を加算器20cに出力する。 The adder 20b adds the steering reaction force torque component (spring term, viscosity term, inertia term) according to the steering characteristic to the calculation result (steering reaction force torque) output by the SAT calculator 23. The spring term is a component proportional to the steering angle, and is calculated by multiplying the steering angle by a predetermined gain. The viscosity term is a component proportional to the steering angular velocity and is calculated by multiplying the steering angular velocity by a predetermined gain. The inertial term is a component proportional to the steering angular acceleration, and is calculated by multiplying the steering angular acceleration by a predetermined gain. Then, the adder 20b outputs the addition result (steering reaction force torque+steering reaction force torque component) to the adder 20c.

操舵反力トルクオフセット部24は、映像処理部4a、車速センサ7a、及び車線維持制御部10が出力した検出結果(白線情報、車速、切り替えゲイン)に基づいて、操舵反力オフセット量を算出する。例えば、操舵反力オフセット量は、操舵反力トルクが大きくなる方向への操舵反力特性(横力−操舵反力変換マップ)をオフセットするためのオフセット量である。操舵反力オフセット量は、車両Aから道路白線までの距離(横位置)が短くなるほど操舵反力トルクが大きくなる方向へオフセットする。そして、操舵反力トルクオフセット部24は、算出結果を加算器20cに出力する。操舵反力トルクオフセット部24の詳細は後述する。 The steering reaction force torque offset unit 24 calculates the steering reaction force offset amount based on the detection results (white line information, vehicle speed, switching gain) output by the image processing unit 4a, the vehicle speed sensor 7a, and the lane keeping control unit 10. .. For example, the steering reaction force offset amount is an offset amount for offsetting the steering reaction force characteristic (lateral force-steering reaction force conversion map) in the direction in which the steering reaction force torque increases. The steering reaction force offset amount is offset in a direction in which the steering reaction force torque increases as the distance (lateral position) from the vehicle A to the road white line decreases. Then, the steering reaction force torque offset unit 24 outputs the calculation result to the adder 20c. Details of the steering reaction force torque offset unit 24 will be described later.

加算器20cは、加算器20bが出力した算出結果(操舵反力トルク+操舵反力トルク成分)に、操舵反力トルクオフセット部24が出力した算出結果(操舵反力オフセット量)を加算する。そして、加算器20cは、加算結果を、指令操舵反力トルク(反力指令)として反力モータ用電流ドライバ9aに出力する。必要であれば、車線維持制御部10にも出力する。 The adder 20c adds the calculation result (steering reaction force offset amount) output by the steering reaction force torque offset unit 24 to the calculation result (steering reaction force torque+steering reaction force torque component) output by the adder 20b. Then, the adder 20c outputs the addition result as the command steering reaction force torque (reaction force command) to the reaction force motor current driver 9a. If necessary, it is also output to the lane keeping control unit 10.

(横力オフセット部22の構成)
図3は、横力オフセット部22の構成例を表すブロック図である。
図3に示すように、横力オフセット部22は、曲率演算部22aと、上下限リミッタ22bと、SATゲイン演算部22cと、乗算器22dと、リミッタ処理部22eとを備える。
(Structure of lateral force offset portion 22)
FIG. 3 is a block diagram showing a configuration example of the lateral force offset unit 22.
As shown in FIG. 3, the lateral force offset unit 22 includes a curvature calculation unit 22a, an upper and lower limit limiter 22b, a SAT gain calculation unit 22c, a multiplier 22d, and a limiter processing unit 22e.

曲率演算部22aは、映像処理部4aが出力した検出結果(白線情報)に基づいて、前方注視点での道路白線の曲率(設定時間(0.5秒)後の車両A位置の道路白線の曲率)を算出する。そして、曲率演算部22aは、算出結果を乗算器22dに出力する。
上下限リミッタ22bは、車速センサ7aが出力した検出結果(車速)に上下限リミッタ処理を行う。上下限リミッタ処理では、例えば、車速が0〜V1(>0)の範囲で車速が大きくなるほど増大し、車速がV1以上の範囲で最大値とする。そして、上下限リミッタ22bは、上下限リミッタ処理後の車速をSATゲイン演算部22cに出力する。
The curvature calculation unit 22a, based on the detection result (white line information) output by the image processing unit 4a, calculates the curvature of the road white line at the forward gazing point (of the road white line at the vehicle A position after the set time (0.5 seconds)). Curvature). Then, the curvature calculation unit 22a outputs the calculation result to the multiplier 22d.
The upper/lower limit limiter 22b performs an upper/lower limit limiter process on the detection result (vehicle speed) output by the vehicle speed sensor 7a. In the upper and lower limit limiter processing, for example, the vehicle speed increases as the vehicle speed increases in the range of 0 to V1 (>0), and reaches the maximum value in the range of V1 or more. Then, the upper and lower limit limiter 22b outputs the vehicle speed after the upper and lower limit limiter processing to the SAT gain calculation unit 22c.

SATゲイン演算部22cは、上下限リミッタ22bが出力した算出結果(リミッタ処理後の車速)に基づいて、車速に応じたSATゲインを算出する。車速に応じたSATゲインは、例えば、車速が0〜70km/hの範囲で車速が大きくなるほど増大し、車速70km/h以上の範囲で最大値になる。また、車速に応じたSATゲインは、車速が大きいときは車速が小さいときよりも、車速の変化量に対する当該SATゲインの変化量が大きくなる。そして、SATゲイン演算部22cは、算出結果を乗算器22dに出力する。 The SAT gain calculator 22c calculates the SAT gain according to the vehicle speed based on the calculation result (vehicle speed after limiter processing) output by the upper and lower limiter 22b. The SAT gain according to the vehicle speed increases, for example, as the vehicle speed increases in the vehicle speed range of 0 to 70 km/h, and reaches the maximum value in the vehicle speed range of 70 km/h or more. Further, the SAT gain according to the vehicle speed has a larger variation amount of the SAT gain with respect to the variation amount of the vehicle speed when the vehicle speed is higher than when the vehicle speed is low. Then, the SAT gain calculator 22c outputs the calculation result to the multiplier 22d.

乗算器22dは、曲率演算部22aが出力した算出結果(前方注視点での道路白線の曲率)にSATゲイン演算部22cが出力した算出結果(車速に応じたSATゲイン)を乗算する。そして、乗算器22dは、乗算結果を横力オフセット量としてリミッタ処理部22eに出力する。これにより、乗算器22dは、前方注視点での道路白線の曲率が大きいほど、つまり、道路白線の曲率半径が小さいほど横力オフセット量を増大できる。
リミッタ処理部22eは、乗算器22dが出力した算出結果(横力オフセット量)の最大値及び変化率の上限を制限する。横力オフセット量の最大値は、1000Nとする。また、横力オフセット量の変化率の上限は、600N/sとする。そして、リミッタ処理部22eは、制限後の横力オフセット量を減算器20aに出力する。
The multiplier 22d multiplies the calculation result output by the curvature calculation unit 22a (curvature of the road white line at the forward gazing point) by the calculation result output by the SAT gain calculation unit 22c (SAT gain according to vehicle speed). Then, the multiplier 22d outputs the multiplication result as a lateral force offset amount to the limiter processing unit 22e. Accordingly, the multiplier 22d can increase the lateral force offset amount as the curvature of the road white line at the forward gazing point is larger, that is, as the radius of curvature of the road white line is smaller.
The limiter processing unit 22e limits the maximum value of the calculation result (lateral force offset amount) output by the multiplier 22d and the upper limit of the rate of change. The maximum lateral force offset amount is 1000N. Moreover, the upper limit of the change rate of the lateral force offset amount is 600 N/s. Then, the limiter processing unit 22e outputs the limited lateral force offset amount to the subtractor 20a.

(操舵反力トルクオフセット部24の構成)
図4は、操舵反力トルクオフセット部24の構成例を表すブロック図である。
図4に示すように、操舵反力トルクオフセット部24は、ヨー角演算部24aと、横位置演算部24bと、逸脱余裕時間に応じた反力演算部25と、横位置に応じた反力演算部26と、反力選択部24cと、リミッタ処理部24dとを備える。
ヨー角演算部24aは、映像処理部4aが出力した検出結果(白線情報)に基づいて、前方注視点でのヨー角(道路白線と車両A進行方向とのなす角度)を算出する。そして、ヨー角演算部24aは、算出結果を逸脱余裕時間に応じた反力演算部25に出力する。
(Structure of Steering Reaction Force Torque Offset Section 24)
FIG. 4 is a block diagram showing a configuration example of the steering reaction force torque offset unit 24.
As shown in FIG. 4, the steering reaction force torque offset unit 24 includes a yaw angle calculation unit 24a, a lateral position calculation unit 24b, a reaction force calculation unit 25 according to the deviation margin time, and a reaction force according to the lateral position. The calculating unit 26, the reaction force selecting unit 24c, and the limiter processing unit 24d are provided.
The yaw angle calculation unit 24a calculates the yaw angle (angle between the road white line and the traveling direction of the vehicle A) at the forward gazing point based on the detection result (white line information) output by the video processing unit 4a. Then, the yaw angle calculation unit 24a outputs the calculation result to the reaction force calculation unit 25 according to the departure margin time.

横位置演算部24bは、映像処理部4a及びナビゲーションシステム17が出力した検出結果(白線情報、車線幅情報)に基づいて、車両Aの現在位置での車両Aから道路白線までの距離(横位置)(以下、現在位置での横位置とも呼ぶ)、及び前方注視点での横位置を算出する。そして、横位置演算部24bは、算出結果を逸脱余裕時間に応じた反力演算部25及び横位置に応じた反力演算部26に出力する。 The lateral position calculating unit 24b calculates the distance (horizontal position) from the vehicle A to the road white line at the current position of the vehicle A based on the detection results (white line information and lane width information) output by the image processing unit 4a and the navigation system 17. ) (Hereinafter also referred to as a lateral position at the current position) and a lateral position at the forward gazing point. Then, the lateral position calculation unit 24b outputs the calculation result to the reaction force calculation unit 25 corresponding to the departure margin time and the reaction force calculation unit 26 corresponding to the lateral position.

逸脱余裕時間に応じた反力演算部25は、車速センサ7a、車線維持制御部10、ヨー角演算部24a、及び横位置演算部24bが出力した検出結果等(車速、切り替えゲイン、前方注視点でのヨー角、前方注視点での横位置)に基づいて、逸脱余裕時間に応じた反力を算出する。逸脱余裕時間に応じた反力としては、例えば、逸脱余裕時間が短いほど増大する反力がある。逸脱余裕時間としては、例えば、車両Aが車線から逸脱するまでに要する時間(余裕時間)がある。そして、逸脱余裕時間に応じた反力演算部25は、算出結果を反力選択部24cに出力する。逸脱余裕時間に応じた反力演算部25の詳細は後述する。 The reaction force calculation unit 25 according to the deviation margin time detects the detection results and the like output from the vehicle speed sensor 7a, the lane keeping control unit 10, the yaw angle calculation unit 24a, and the lateral position calculation unit 24b (vehicle speed, switching gain, forward gazing point). The reaction force corresponding to the departure margin time is calculated based on the yaw angle at and the lateral position at the forward gazing point. As the reaction force according to the departure margin time, for example, there is a reaction force that increases as the departure margin time decreases. The deviation margin time is, for example, a time (margin time) required for the vehicle A to deviate from the lane. Then, the reaction force calculation unit 25 according to the departure margin time outputs the calculation result to the reaction force selection unit 24c. Details of the reaction force calculation unit 25 according to the deviation margin time will be described later.

横位置に応じた反力演算部26は、車線維持制御部10及び横位置演算部24bが出力した算出結果(切り替えゲイン、現在位置での横位置)に基づいて、横位置に応じた反力を算出する。横位置に応じた反力としては、例えば、横位置偏差が長いほど増大する反力がある。横位置偏差としては、例えば、車両Aから目標左横位置までの距離及び車両Aから目標右横位置までの距離のうち大きいほうがある。また、目標左横位置としては、例えば、左道路白線から道路中央側90cmの位置がある。目標右横位置としては、例えば、右道路白線から道路中央側90cmの位置がある。そして、横位置に応じた反力演算部26は、算出結果を反力選択部24cに出力する。横位置に応じた反力演算部26の詳細は後述する。 The reaction force calculation unit 26 according to the lateral position, based on the calculation results (switching gain, lateral position at the current position) output by the lane keeping control unit 10 and the lateral position calculation unit 24b, the reaction force according to the lateral position. To calculate. An example of the reaction force according to the lateral position is a reaction force that increases as the lateral position deviation increases. The lateral position deviation is, for example, the larger one of the distance from the vehicle A to the target left lateral position and the distance from the vehicle A to the target right lateral position. Further, the target left lateral position is, for example, a position 90 cm from the left road white line to the road center side. The target right lateral position is, for example, a position 90 cm from the right road white line to the road center side. Then, the reaction force calculation unit 26 according to the lateral position outputs the calculation result to the reaction force selection unit 24c. Details of the reaction force calculation unit 26 according to the lateral position will be described later.

反力選択部24cは、逸脱余裕時間に応じた反力演算部25が出力した算出結果(逸脱余裕時間に応じた反力)と、横位置に応じた反力演算部26が出力した算出結果(横位置に応じた反力)のうち絶対値が大きなほうを選択する。そして、反力選択部24cは、選択結果を操舵反力オフセット量としてリミッタ処理部24dに出力する。
リミッタ処理部24dは、反力選択部24cが出力した選択結果(操舵反力オフセット量)の最大値及び変化率の上限を制限する。操舵反力オフセット量の最大値は、2Nmとする。また、操舵反力オフセット量の変化量の上限は、10Nm/sとする。そして、リミッタ処理部24dは、制限後の操舵反力オフセット量を加算器20c(図2参照)に出力する。
The reaction force selection unit 24c outputs the calculation result output by the reaction force calculation unit 25 according to the deviation time (reaction force according to the deviation time) and the calculation result output by the reaction force calculation unit 26 according to the lateral position. Select the one with the larger absolute value of (reaction force according to the lateral position). Then, the reaction force selection unit 24c outputs the selection result to the limiter processing unit 24d as the steering reaction force offset amount.
The limiter processing unit 24d limits the maximum value of the selection result (steering reaction force offset amount) output by the reaction force selecting unit 24c and the upper limit of the rate of change. The maximum value of the steering reaction force offset amount is 2 Nm. The upper limit of the amount of change in the steering reaction force offset amount is 10 Nm/s. Then, the limiter processing unit 24d outputs the limited steering reaction force offset amount to the adder 20c (see FIG. 2).

(逸脱余裕時間に応じた反力演算部25の構成)
図5は、逸脱余裕時間に応じた反力演算部25の構成例を表すブロック図である。
図5に示すように、逸脱余裕時間に応じた反力演算部25は、乗算器25aと、除算器25bと、除算器25cと、逸脱余裕時間選択部25dと、逸脱余裕時間反力マップ演算部25eとを備える。
(Structure of the reaction force calculation unit 25 according to the deviation time)
FIG. 5 is a block diagram showing a configuration example of the reaction force calculation unit 25 according to the deviation margin time.
As shown in FIG. 5, the reaction force computing unit 25 according to the departure margin time includes a multiplier 25a, a divider 25b, a divider 25c, a departure margin time selecting unit 25d, and a departure margin time reaction force map calculation. And a section 25e.

乗算器25aは、ヨー角演算部24aが出力した算出結果(ヨー角)に車速を乗算する。そして、乗算器25aは、乗算結果(以下、車両Aの横速度とも呼ぶ)を除算器25b及び除算器25cに出力する。
除算器25bは、横位置演算部24bが出力した算出結果(現在位置での横位置)のうち、前方注視点での車両Aから左道路白線までの距離(左道路白線に対する横位置)を、乗算器25aが出力した算出結果(横速度)で除算する。そして、除算器25bは、除算結果(以下、左道路白線に対する逸脱余裕時間とも呼ぶ)を逸脱余裕時間選択部25dに出力する。
The multiplier 25a multiplies the calculation result (yaw angle) output by the yaw angle calculator 24a by the vehicle speed. Then, the multiplier 25a outputs the multiplication result (hereinafter, also referred to as the lateral speed of the vehicle A) to the divider 25b and the divider 25c.
The divider 25b calculates the distance (horizontal position with respect to the left road white line) from the vehicle A at the forward gazing point to the left road white line in the calculation result (horizontal position at the current position) output by the lateral position calculation unit 24b. It is divided by the calculation result (lateral velocity) output by the multiplier 25a. Then, the divider 25b outputs the division result (hereinafter, also referred to as a departure margin time for the left road white line) to the departure margin time selection unit 25d.

除算器25cは、横位置演算部24bが出力した算出結果(現在位置での横位置)のうち、前方注視点での車両Aから右道路白線までの距離(右道路白線に対する横位置)を、乗算器25aが出力した算出結果(横速度)で除算する。そして、除算器25bは、除算結果(以下、右道路白線に対する逸脱余裕時間とも呼ぶ)を逸脱余裕時間選択部25dに出力する。
逸脱余裕時間選択部25dは、除算器25bが出力した算出結果(左道路白線に対する逸脱余裕時間)及び除算器25cが出力した算出結果(右道路白線に対する逸脱余裕時間)のうち短いほうを選択する。そして、逸脱余裕時間選択部25dは、選択結果(以下、逸脱余裕時間とも呼ぶ)を逸脱余裕時間反力マップ演算部25eに出力する。
The divider 25c calculates the distance (horizontal position relative to the right road white line) from the vehicle A at the front gazing point to the right road white line in the calculation result (horizontal position at the current position) output by the lateral position calculation unit 24b. It is divided by the calculation result (lateral velocity) output by the multiplier 25a. Then, the divider 25b outputs the division result (hereinafter, also referred to as a departure margin time for the right road white line) to the departure margin time selection unit 25d.
The departure margin time selecting unit 25d selects the shorter one of the calculation result output by the divider 25b (the departure margin time for the left road white line) and the calculation result output by the divider 25c (the departure margin time for the right road white line). .. Then, the deviation margin time selecting unit 25d outputs the selection result (hereinafter, also referred to as deviation margin time) to the deviation margin time reaction force map calculating unit 25e.

逸脱余裕時間反力マップ演算部25eは、車線維持制御部10が出力した算出結果(切り替えゲイン)及び逸脱余裕時間選択部25dが出力した算出結果(逸脱余裕時間)に基づいて、逸脱余裕時間に応じた反力を算出する。逸脱余裕時間に応じた反力は、逸脱余裕時間が3秒以上の範囲で最低値(例えば、ほぼ0)となり、逸脱余裕時間が0〜3秒の範囲で逸脱余裕時間が短いほど増大する(逸脱余裕時間に反比例した値となる)。そして、逸脱余裕時間反力マップ演算部25eは、算出結果(逸脱余裕時間に応じた反力)を反力選択部24c(図4参照)に出力する。これにより、逸脱余裕時間に応じた反力は、逸脱余裕時間が短いほど増大する。 The departure margin time reaction force map calculating unit 25e determines the departure margin time based on the calculation result (switching gain) output by the lane keeping control unit 10 and the calculation result (departure margin time) output by the departure margin time selecting unit 25d. Calculate the corresponding reaction force. The reaction force corresponding to the departure margin time has a minimum value (for example, almost 0) in the range of the departure margin time of 3 seconds or more, and increases as the departure margin time becomes shorter in the range of the departure margin time of 0 to 3 seconds ( The value will be inversely proportional to the deviation margin time). The departure margin time reaction force map calculation unit 25e outputs the calculation result (reaction force corresponding to the departure margin time) to the reaction force selection unit 24c (see FIG. 4). As a result, the reaction force corresponding to the departure margin time increases as the departure margin time decreases.

本実施形態では、逸脱余裕時間反力マップ演算部25eは、逸脱余裕時間に応じた操舵反力トルクのマップ(逸脱余裕時間−反力変換マップ)を車線の切り増し側(逸脱側)と切り戻し側(逸脱回避側)との2種類用意する。例えば、逸脱余裕時間−反力変換マップとして、第1の逸脱側マップと、第1の逸脱回避側マップとを用意する。そして、それぞれのマップに対して切り替えゲインを適用することで、逸脱余裕時間に応じた反力を算出する。切り替えゲインの適用の詳細は後述する。 In the present embodiment, the departure margin time reaction force map calculator 25e switches the steering reaction force torque map (departure margin time-reaction force conversion map) according to the departure margin time to the lane increase side (departure side). Two types are prepared: the return side (departure avoidance side). For example, a first departure side map and a first departure avoidance side map are prepared as departure margin time-reaction force conversion maps. Then, by applying the switching gain to each map, the reaction force according to the deviation margin time is calculated. Details of applying the switching gain will be described later.

(横位置に応じた反力演算部26)
図6は、横位置に応じた反力演算部26の構成例を表すブロック図である。
図6に示すように、横位置に応じた反力演算部26は、減算器26aと、減算器26bと、横位置偏差選択部26cと、横位置偏差反力マップ演算部26dとを備える。
減算器26aは、横位置演算部24bが出力した算出結果(車両Aの現在位置での車両Aから左道路白線までの距離(左道路白線に対する横位置))から予め定めた目標左横位置(例えば、90cm)を減算する。そして、減算器26aは、減算結果(以下、左道路白線に対する横位置偏差とも呼ぶ)を横位置偏差選択部26cに出力する。
(Reaction force calculation unit 26 according to lateral position)
FIG. 6 is a block diagram showing a configuration example of the reaction force calculation unit 26 according to the lateral position.
As shown in FIG. 6, the reaction force computing unit 26 according to the lateral position includes a subtractor 26a, a subtractor 26b, a lateral position deviation selecting unit 26c, and a lateral position deviation reaction force map computing unit 26d.
The subtractor 26a outputs a predetermined target left lateral position (a lateral position relative to the left road white line from the vehicle A at the current position of the vehicle A to the left road white line) output by the lateral position calculator 24b. For example, 90 cm) is subtracted. Then, the subtractor 26a outputs the subtraction result (hereinafter, also referred to as lateral position deviation with respect to the left road white line) to the lateral position deviation selection unit 26c.

減算器26bは、横位置演算部24bが出力した算出結果(車両Aの現在位置での車両Aから右道路白線までの距離(右道路白線に対する横位置))から予め定めた目標右横位置(例えば、90cm)を減算する。そして、減算器26bは、減算結果(以下、右道路白線に対する横位置偏差とも呼ぶ)を横位置偏差選択部26cに出力する。
横位置偏差選択部26cは、減算器26aが出力した算出結果(左道路白線に対する横位置偏差)及び減算器26bが出力した算出結果(右道路白線に対する横位置偏差)のうち大きいほうを選択する。そして、横位置偏差選択部26cは、選択結果(以下、横位置偏差とも呼ぶ)を横位置偏差反力マップ演算部26dに出力する。
The subtracter 26b outputs a predetermined target right lateral position (horizontal position relative to the right road white line from the vehicle A at the current position of the vehicle A to the right road white line) output by the lateral position calculator 24b ( For example, 90 cm) is subtracted. Then, the subtractor 26b outputs the subtraction result (hereinafter, also referred to as lateral position deviation with respect to the right road white line) to the lateral position deviation selection unit 26c.
The lateral position deviation selecting unit 26c selects the larger one of the calculation result output by the subtractor 26a (lateral position deviation for the left road white line) and the calculation result output by the subtractor 26b (lateral position deviation for the right road white line). .. Then, the lateral position deviation selection unit 26c outputs the selection result (hereinafter, also referred to as lateral position deviation) to the lateral position deviation reaction force map calculation unit 26d.

横位置偏差反力マップ演算部26dは、車線維持制御部10が出力した算出結果(切り替えゲイン)及び横位置偏差選択部26cが出力した算出結果(横位置偏差)に基づいて、横位置に応じた反力を算出する。横位置に応じた反力は、横位置偏差が設定値未満の範囲で横位置偏差が大きくなるほど増大し、横位置偏差が設定値以上の範囲で最大値になる。そして、横位置偏差反力マップ演算部26dは、算出結果(横位置に応じた反力)を反力選択部24c(図4参照)に出力する。これにより、横位置に応じた反力は、横位置偏差が長いほど増大する。 The lateral position deviation reaction force map calculation unit 26d determines the lateral position based on the calculation result (switching gain) output by the lane keeping control unit 10 and the calculation result (lateral position deviation) output by the lateral position deviation selection unit 26c. Calculate the reaction force. The reaction force corresponding to the lateral position increases as the lateral position deviation increases in the range where the lateral position deviation is less than the set value, and reaches the maximum value in the range where the lateral position deviation is equal to or greater than the set value. Then, the lateral position deviation reaction force map calculation unit 26d outputs the calculation result (reaction force corresponding to the lateral position) to the reaction force selection unit 24c (see FIG. 4). As a result, the reaction force corresponding to the lateral position increases as the lateral position deviation increases.

本実施形態では、横位置偏差反力マップ演算部26dは、横位置に応じた操舵反力トルクのマップ(横位置偏差−反力変換マップ)を車線の切り増し側(逸脱側)と切り戻し側(逸脱回避側)との2種類用意する。例えば、横位置偏差−反力変換マップとして、第2の逸脱側マップと、第2の逸脱回避側マップとを用意する。そして、それぞれのマップに対して切り替えゲインを適用することで、横位置に応じた反力を算出する。切り替えゲインの適用の詳細は後述する。 In the present embodiment, the lateral position deviation reaction force map calculator 26d switches back the steering reaction force torque map (lateral position deviation-reaction force conversion map) according to the lateral position to the lane increase side (departure side). There are two types: the side (departure avoidance side). For example, a second deviation side map and a second deviation avoidance side map are prepared as the lateral position deviation-reaction force conversion map. Then, by applying the switching gain to each map, the reaction force according to the lateral position is calculated. Details of applying the switching gain will be described later.

なお、本実施形態では、上記の逸脱余裕時間反力マップ演算部25e及び横位置偏差反力マップ演算部26dで使用される切り替えゲインは、車線維持制御部10により算出される。ここでは、車線維持制御部10と操舵反力制御部20とはそれぞれ独立した構成としている。但し、実際には、車線維持制御部10は、操舵反力制御部20の一部でも良い。例えば、車線維持制御部10は、操舵反力トルクオフセット部24の一部でも良い。以下に、車線維持制御部10の詳細について説明する。 In the present embodiment, the lane keeping control unit 10 calculates the switching gains used by the deviation margin reaction force map calculator 25e and the lateral position deviation reaction force map calculator 26d. Here, the lane keeping control unit 10 and the steering reaction force control unit 20 are independently configured. However, in practice, the lane keeping control unit 10 may be a part of the steering reaction force control unit 20. For example, the lane keeping control unit 10 may be a part of the steering reaction force torque offset unit 24. The details of the lane keeping control unit 10 will be described below.

(車線維持制御部10の構成)
図7は、車線維持制御部10の構成例を表すブロック図である。
図7に示すように、車線維持制御部10は、補正操舵角設定部10aと、ラッチ操舵角更新部10bと、切り替えゲイン演算部10cとを備える。
(Structure of Lane Keeping Control Unit 10)
FIG. 7 is a block diagram showing a configuration example of the lane keeping control unit 10.
As shown in FIG. 7, the lane keeping control unit 10 includes a correction steering angle setting unit 10a, a latch steering angle updating unit 10b, and a switching gain calculation unit 10c.

(補正操舵角の設定)
図8は、補正操舵角の設定に関するフローチャートである。また、図9は、後述する現在操舵角、補正操舵角、及び無効操舵角の各々の関係と、図8に示す処理フローの各段階における現在操舵角及び補正操舵角の変化を示すグラフである。
(Corrected steering angle setting)
FIG. 8 is a flowchart regarding the setting of the corrected steering angle. Further, FIG. 9 is a graph showing a relationship between each of a current steering angle, a corrected steering angle, and an invalid steering angle, which will be described later, and a change in the current steering angle and the corrected steering angle at each stage of the processing flow shown in FIG. ..

補正操舵角設定部10aは、操舵角センサ1dが出力した検出結果(操舵角)に基づき、現在の操舵角(現在操舵角)が、補正に用いる操舵角(補正操舵角)に既定の無効操舵角を加算した操舵角以上(現在操舵角≧補正操舵角+無効操舵角)であるか判断する(ステップS101)。ここでは、補正操舵角の初期値は0度である。無効操舵角はステアリングホイール1aの切り返しにおける「遊び」(緩み)に相当する操舵角(不感帯)であり、この無効操舵角の分は回転しても無視する。なお、無効操舵角は、例えば1度である。無効操舵角は、予め設定された固定値でも良い。 Based on the detection result (steering angle) output by the steering angle sensor 1d, the corrected steering angle setting unit 10a sets the current steering angle (current steering angle) to the steering angle used for correction (corrected steering angle), which is the default invalid steering. It is determined whether or not the steering angle obtained by adding the angles is greater than or equal to the present steering angle (current steering angle≧corrected steering angle+ineffective steering angle) (step S101). Here, the initial value of the corrected steering angle is 0 degree. The invalid steering angle is a steering angle (dead zone) corresponding to "play" (loosening) when the steering wheel 1a is turned back, and the invalid steering angle is ignored even if it rotates. The invalid steering angle is, for example, 1 degree. The invalid steering angle may be a preset fixed value.

現在操舵角が補正操舵角に無効操舵角を加算した操舵角以上である場合(ステップS101でYes)、補正操舵角設定部10aは、補正操舵角を更新する(ステップS102)。ここでは、補正操舵角設定部10aは、補正操舵角を、現在操舵角から無効操舵角を減じた操舵角に置き換える(補正操舵角=現在操舵角−無効操舵角)。なお、現在操舵角が補正操舵角に無効操舵角を加算した操舵角以上である場合とは、ステアリングホイール1aを切り増し側(逸脱側)に切っている状況である。このとき、補正操舵角は、常に、現在操舵角から無効操舵角を減算した値を保っている。 When the current steering angle is equal to or larger than the steering angle obtained by adding the invalid steering angle to the corrected steering angle (Yes in step S101), the corrected steering angle setting unit 10a updates the corrected steering angle (step S102). Here, the corrected steering angle setting unit 10a replaces the corrected steering angle with the steering angle obtained by subtracting the invalid steering angle from the current steering angle (corrected steering angle=current steering angle−ineffective steering angle). The case where the current steering angle is equal to or larger than the steering angle obtained by adding the invalid steering angle to the corrected steering angle is a situation in which the steering wheel 1a is turned to the additional side (departure side). At this time, the corrected steering angle always holds the value obtained by subtracting the invalid steering angle from the current steering angle.

現在操舵角が補正操舵角に無効操舵角を加算した操舵角以上ではない場合(ステップS101でNo)、補正操舵角設定部10aは、現在操舵角が補正操舵角から無効操舵角を減じた操舵角以下(現在操舵角≦補正操舵角−無効操舵角)であるか判断する(ステップS103)。
現在操舵角が補正操舵角から無効操舵角を減じた操舵角以下である場合(ステップS103でYes)、補正操舵角設定部10aは、補正操舵角を更新する(ステップS104)。ここでは、補正操舵角設定部10aは、補正操舵角を、現在操舵角に無効操舵角を加算した操舵角に置き換える(補正操舵角=現在操舵角+無効操舵角)。なお、現在操舵角が補正操舵角から無効操舵角を減じた操舵角以下である場合とは、ステアリングホイール1aを切り戻し側(逸脱回避側)に切っている状況である。このとき、補正操舵角は、常に、現在操舵角に無効操舵角を加算した値を保っている。
When the current steering angle is not greater than or equal to the steering angle obtained by adding the invalid steering angle to the corrected steering angle (No in step S101), the correction steering angle setting unit 10a determines that the current steering angle is the corrected steering angle minus the invalid steering angle. It is determined whether the angle is less than or equal to the angle (current steering angle≦correction steering angle−ineffective steering angle) (step S103).
When the current steering angle is equal to or smaller than the steering angle obtained by subtracting the invalid steering angle from the corrected steering angle (Yes in step S103), the corrected steering angle setting unit 10a updates the corrected steering angle (step S104). Here, the corrected steering angle setting unit 10a replaces the corrected steering angle with the steering angle obtained by adding the invalid steering angle to the current steering angle (corrected steering angle=current steering angle+ineffective steering angle). The case where the current steering angle is equal to or smaller than the steering angle obtained by subtracting the invalid steering angle from the corrected steering angle is a situation where the steering wheel 1a is turned to the return side (departure avoidance side). At this time, the corrected steering angle always maintains a value obtained by adding the invalid steering angle to the current steering angle.

ここで、補正操舵角設定部10aは、現在操舵角が0度(中立位置)になったか判断する(ステップS105)。現在操舵角が0度になっていない場合(ステップS105でNo)には、未だステアリングホイール1aを切り戻し側(逸脱回避側)に切っている状況であるため、上記の処理(ステップS104)で更新した補正操舵角を用いる。
現在操舵角が0度になった場合(ステップS105でYes)、現在操舵角をそれ以上補正する必要がないため、補正操舵角設定部10aは、補正操舵角を直ちに0にする。すなわち、補正操舵角を初期化する。なお、車線維持制御において、現在操舵角が0度となるのは、車両が車線に沿って道なりに走行する時(例えば車線中央を走行する時)であると考えられる。車線がカーブである場合には、上記の現在操舵角の「0度」を「カーブ曲率又は転舵角に応じた最適な操舵角」としても良い。但し、実際には、これらの例に限定されない。
Here, the corrected steering angle setting unit 10a determines whether the current steering angle is 0 degrees (the neutral position) (step S105). If the steering angle is not currently 0 degrees (No in step S105), it means that the steering wheel 1a is still in the turning-back side (departure avoidance side). The updated corrected steering angle is used.
When the current steering angle becomes 0 degrees (Yes in step S105), it is not necessary to correct the current steering angle any more, so the correction steering angle setting unit 10a immediately sets the correction steering angle to 0. That is, the corrected steering angle is initialized. In the lane keeping control, it is considered that the current steering angle becomes 0 degree when the vehicle travels along the lane along the road (for example, when traveling in the center of the lane). When the lane is a curve, “0 degrees” of the current steering angle may be set as the “optimal steering angle according to the curve curvature or the turning angle”. However, actually, it is not limited to these examples.

現在操舵角が補正操舵角から無効操舵角を減じた操舵角以下でない場合(ステップS103でNo)、補正操舵角設定部10aは、補正操舵角を更新せずに現状維持する(ステップS107)。例えば、運転者がステアリングホイール1aを切り増し側(逸脱側)に切り始めた状況で現在操舵角が無効操舵角以下である場合や、運転者がステアリングホイール1aを回転させず一定の操舵角で固定している状況(保舵状態)で現在操舵角が変化していない場合には、補正操舵角設定部10aは、補正操舵角を更新せずに現状維持する。
補正操舵角設定部10aは、補正操舵角をラッチ操舵角更新部10bに出力する(ステップS108)。
If the current steering angle is not less than or equal to the steering angle obtained by subtracting the invalid steering angle from the corrected steering angle (No in step S103), the corrected steering angle setting unit 10a maintains the current state without updating the corrected steering angle (step S107). For example, when the current steering angle is equal to or less than the invalid steering angle in a situation where the driver starts to turn the steering wheel 1a to the side of increasing (departure side), or the driver does not rotate the steering wheel 1a and the steering angle is constant. When the steering angle is not currently changing in the fixed state (steering state), the corrected steering angle setting unit 10a maintains the current state without updating the corrected steering angle.
The corrected steering angle setting unit 10a outputs the corrected steering angle to the latch steering angle updating unit 10b (step S108).

(ラッチ操舵角の更新)
図10Aは、ラッチ操舵角の更新に関するフローチャートである。
ラッチ操舵角更新部10bは、操舵反力制御部20から出力される指令操舵反力トルク(反力指令)を監視する。例えば、ラッチ操舵角更新部10bは、操舵反力制御部20から出力される指令操舵反力トルクを毎回ラッチしても良い。このとき、ラッチ操舵角更新部10bは、少なくとも直近の2回分の指令値、すなわち指令操舵反力トルクの前回値(直前に出力した反力指令)と前々回値(その1つ前に出力した反力指令)とを保持する。そして、ラッチ操舵角更新部10bは、指令操舵反力トルクの前回値が0又は前々回値と逆符号であるか判断する(ステップS201)。すなわち、ステアリングホイール1aの回転方向の切り替え(切り増し→切り戻し、又は切り戻し→切り増し)があるか判断する。指令操舵反力トルクの前回値が0でも前々回値と逆符号でもない場合(ステップS201でNo)、ステアリングホイール1aの回転方向の切り替えがないため、補正操舵角をラッチ(保存)しない。すなわち、現在ラッチされている操舵角(ラッチ操舵角)を初期化しない。
(Latch steering angle update)
FIG. 10A is a flowchart regarding the update of the latch steering angle.
The latch steering angle updating unit 10b monitors the command steering reaction force torque (reaction force command) output from the steering reaction force control unit 20. For example, the latch steering angle updating unit 10b may latch the command steering reaction force torque output from the steering reaction force control unit 20 every time. At this time, the latch steering angle updating unit 10b outputs the command value for at least the latest two times, that is, the previous value of the command steering reaction force torque (the reaction force command output immediately before) and the value two times before (the reaction output immediately before that). Force command) and. Then, the latch steering angle updating unit 10b determines whether the previous value of the command steering reaction force torque is 0 or the sign opposite to the two-previous value (step S201). That is, it is determined whether or not the rotation direction of the steering wheel 1a is switched (cut-up→cut-back or cut-back→cut-up). If the previous value of the command steering reaction force torque is neither 0 nor the sign opposite to the value before last (No in step S201), the correction steering angle is not latched (saved) because the rotation direction of the steering wheel 1a is not switched. That is, the steering angle currently being latched (latch steering angle) is not initialized.

指令操舵反力トルクの前回値が0又は前々回値と逆符号である場合(ステップS201でYes)、ステアリングホイール1aの回転方向の切り替えが発生したため、ラッチ操舵角更新部10bは、補正操舵角設定部10aが出力した補正操舵角をラッチする(ステップS202)。すなわち、ラッチ操舵角を初期化するため、ラッチ操舵角の値に、その時点での補正操舵角を代入する(ラッチ操舵角=補正操舵角)。 When the previous value of the command steering reaction force torque is 0 or the opposite sign to the value before two times (Yes in step S201), switching of the rotation direction of the steering wheel 1a has occurred, so the latch steering angle updating unit 10b sets the correction steering angle setting. The corrected steering angle output by the unit 10a is latched (step S202). That is, in order to initialize the latch steering angle, the corrected steering angle at that time is substituted for the value of the latch steering angle (latch steering angle=corrected steering angle).

ラッチ操舵角更新部10bは、ステアリングホイール1aに左方向への操舵反力トルクが発生しているか判断する(ステップS203)。なお、ステアリングホイール1aに左方向への操舵反力トルクが発生するのは、車両Aが車線の右側の道路白線に近い又は近づいている状態であり、車両Aを車線の中央側に戻そうとする左方向の反力が発生している状態である。
ステアリングホイール1aに左方向への操舵反力トルクが発生している場合(ステップS203でYes)、ラッチ操舵角更新部10bは、図10Bに示す左方向対応処理を行い、ラッチ操舵角を更新する。左方向対応処理の詳細は後述する。
The latch steering angle updating unit 10b determines whether the steering reaction torque to the left is generated in the steering wheel 1a (step S203). The steering reaction force torque to the left is generated in the steering wheel 1a when the vehicle A is close to or near the road white line on the right side of the lane, and when the vehicle A is returned to the center side of the lane. The reaction force in the left direction is generated.
When the steering reaction force torque to the left is generated in the steering wheel 1a (Yes in step S203), the latch steering angle update unit 10b performs the leftward correspondence process shown in FIG. 10B to update the latch steering angle. .. The details of the left direction correspondence processing will be described later.

また、ラッチ操舵角更新部10bは、ステアリングホイール1aに左方向への操舵反力トルクが発生していない場合(ステップS203でNo)、ステアリングホイール1aに右方向への操舵反力トルクが発生しているか判断する(ステップS204)。なお、ステアリングホイール1aに右方向への操舵反力トルクが発生するのは、車両Aが車線の左側の道路白線に近い又は近づいている状態であり、車両Aを車線の中央側に戻そうとする右方向の反力が発生している状態である。 Further, when the steering reaction force torque to the left is not generated in the steering wheel 1a (No in step S203), the latch steering angle updating unit 10b generates the steering reaction force torque to the right in the steering wheel 1a. It is determined whether or not (step S204). The steering reaction force torque to the right is generated in the steering wheel 1a when the vehicle A is close to or near the road white line on the left side of the lane, and when the vehicle A is returned to the center side of the lane. A reaction force in the right direction is generated.

ステアリングホイール1aに右方向への操舵反力トルクが発生している場合(ステップS204でYes)、ラッチ操舵角更新部10bは、図10Cに示す右方向対応処理を行い、ラッチ操舵角を更新する。右方向対応処理の詳細は後述する。
ラッチ操舵角更新部10bは、補正操舵角及びラッチ操舵角を切り替えゲイン演算部10cに出力する(ステップS205)。
When the steering reaction force torque in the right direction is generated in the steering wheel 1a (Yes in step S204), the latch steering angle updating unit 10b performs the right direction correspondence process shown in FIG. 10C to update the latch steering angle. .. The details of the right direction correspondence processing will be described later.
The latch steering angle updating unit 10b switches the corrected steering angle and the latch steering angle to the gain calculation unit 10c (step S205).

(左方向対応処理)
図10Bは、ラッチ操舵角の更新における左方向対応処理に関するフローチャートである。
ステアリングホイール1aに左方向への操舵反力トルクが発生している場合(図10AのステップS203でYes)、ラッチ操舵角更新部10bは、補正操舵角がラッチ操舵角より大きい値(補正操舵角>ラッチ操舵角)であるか判断する(ステップS211)。
(Left direction processing)
FIG. 10B is a flowchart relating to leftward correspondence processing in updating the latch steering angle.
When the steering reaction force torque to the left is generated in the steering wheel 1a (Yes in step S203 of FIG. 10A), the latch steering angle updating unit 10b determines that the corrected steering angle is larger than the latch steering angle (corrected steering angle). >Latch steering angle) is determined (step S211).

補正操舵角がラッチ操舵角より大きくない場合(ステップS211でNo)、ラッチ操舵角更新部10bは、映像処理部4a及び操舵反力制御部20が出力した検出結果(白線情報、指令操舵反力トルク)に基づいて、道路のカーブ曲率が閾値以上かつ指令操舵反力トルクがカーブ外側方向に閾値以上であるか判断する(ステップS212)。すなわち、ステアリングホイール1aやコラムシャフト1bの捩れ(フリクション)分のトルクを検知できるか判断する。例えば、カーブを走行中に運転者がステアリングホイール1aに加える力を緩めているときには、フリクションが発生しないため、フリクション分のトルクを検知できない。 When the corrected steering angle is not larger than the latch steering angle (No in step S211), the latch steering angle updating unit 10b outputs the detection result (white line information, command steering reaction force) output by the image processing unit 4a and the steering reaction force control unit 20. Based on (torque), it is determined whether the curve curvature of the road is equal to or greater than a threshold value and the command steering reaction force torque is equal to or greater than the threshold value in the curve outward direction (step S212). That is, it is determined whether the torque corresponding to the twist (friction) of the steering wheel 1a or the column shaft 1b can be detected. For example, when the driver loosens the force applied to the steering wheel 1a while traveling on a curve, friction does not occur, and therefore the torque for the friction cannot be detected.

補正操舵角がラッチ操舵角より大きい場合(ステップS211でYes)、又は、道路のカーブ曲率が閾値以上かつ指令操舵反力トルクがカーブ外側方向に閾値以上である場合(ステップS212でYes)、ラッチ操舵角更新部10bは、補正操舵角をラッチする(ステップS213)。すなわち、ラッチ操舵角を更新するため、ラッチ操舵角の値に、その時点での補正操舵角を代入する(ラッチ操舵角=補正操舵角)。すなわち、ラッチ操舵角の最大値が更新される。 If the corrected steering angle is larger than the latch steering angle (Yes in step S211), or if the curve curvature of the road is greater than or equal to the threshold value and the command steering reaction torque is greater than or equal to the threshold value in the outward curve direction (Yes in step S212), the latch is performed. The steering angle updating unit 10b latches the corrected steering angle (step S213). That is, in order to update the latch steering angle, the corrected steering angle at that time is substituted for the value of the latch steering angle (latch steering angle=corrected steering angle). That is, the maximum value of the latch steering angle is updated.

道路のカーブ曲率が閾値以上かつ指令操舵反力トルクがカーブ外側方向に閾値以上ではない場合(ステップS212でNo)、ラッチ操舵角更新部10bは、補正操舵角が、ラッチ操舵角から操舵角ヒス(ヒステリシス値)を減じた操舵角より大きいか判断する(ステップS214)。なお、操舵角ヒスは、例えば1度である。操舵角ヒスは、予め設定された固定値でも良い。補正操舵角が、ラッチ操舵角から操舵角ヒスを減じた操舵角より大きくない場合(ステップS214でNo)、ラッチ操舵角更新部10bは、何もしない。 When the curve curvature of the road is equal to or greater than the threshold and the command steering reaction force torque is not equal to or greater than the threshold in the curve outward direction (No in step S212), the latch steering angle updating unit 10b determines that the corrected steering angle is from the latch steering angle to the steering angle hysteresis. It is determined whether the steering angle is smaller than the (hysteresis value) (step S214). The steering angle hiss is, for example, 1 degree. The steering angle hiss may be a preset fixed value. When the corrected steering angle is not larger than the steering angle obtained by subtracting the steering angle hiss from the latch steering angle (No in step S214), the latch steering angle updating unit 10b does nothing.

補正操舵角が、ラッチ操舵角から操舵角ヒスを減じた操舵角より大きい場合(ステップS214でYes)、ラッチ操舵角更新部10bは、補正操舵角に操舵角ヒスを加算した操舵角をラッチする(ステップS215)。これにより、ラッチ操舵角は更新され、補正操舵角に操舵角ヒスを加算した操舵角となる(ラッチ操舵角=補正操舵角+操舵角ヒス)。ここでは、ゲインを1よりも大きくしないために、ラッチ操舵角と補正操舵角との差分を操舵角ヒス分までとしている。 When the corrected steering angle is larger than the steering angle obtained by subtracting the steering angle hiss from the latch steering angle (Yes in step S214), the latch steering angle updating unit 10b latches the steering angle obtained by adding the steering angle hiss to the corrected steering angle. (Step S215). As a result, the latch steering angle is updated and becomes the steering angle obtained by adding the steering angle hiss to the corrected steering angle (latch steering angle=corrected steering angle+steering angle hiss). Here, since the gain is not larger than 1, the difference between the latch steering angle and the corrected steering angle is up to the steering angle hiss.

(右方向対応処理)
図10Cは、ラッチ操舵角の更新における右方向対応処理に関するフローチャートである。
ステアリングホイール1aに右方向への操舵反力トルクが発生している場合(図10AのステップS204でYes)、ラッチ操舵角更新部10bは、補正操舵角がラッチ操舵角より小さい値(補正操舵角<ラッチ操舵角)であるか判断する(ステップS221)。
(Processing for right direction)
FIG. 10C is a flowchart relating to rightward handling processing in updating the latch steering angle.
When the steering reaction torque in the right direction is generated in the steering wheel 1a (Yes in step S204 of FIG. 10A), the latch steering angle updating unit 10b determines that the corrected steering angle is smaller than the latch steering angle (corrected steering angle). It is determined whether it is <latch steering angle) (step S221).

補正操舵角がラッチ操舵角より小さくない場合(ステップS221でNo)、ラッチ操舵角更新部10bは、道路のカーブ曲率が閾値以上かつ指令操舵反力トルクがカーブ外側方向に閾値以上であるか判断する(ステップS222)。
補正操舵角がラッチ操舵角より小さい場合(ステップS221でYes)、又は、道路のカーブ曲率が閾値以上かつ指令操舵反力トルクがカーブ外側方向に閾値以上である場合(ステップS222でYes)、ラッチ操舵角更新部10bは、補正操舵角をラッチする(ステップS223)。すなわち、ラッチ操舵角を更新するため、ラッチ操舵角の値に、その時点での補正操舵角を代入する(ラッチ操舵角=補正操舵角)。
When the corrected steering angle is not smaller than the latch steering angle (No in step S221), the latch steering angle updating unit 10b determines whether the curve curvature of the road is equal to or greater than the threshold and the command steering reaction force torque is equal to or greater than the threshold in the outward curve direction. Yes (step S222).
If the corrected steering angle is smaller than the latch steering angle (Yes in step S221), or if the curve curvature of the road is greater than or equal to the threshold value and the command steering reaction torque is greater than or equal to the threshold value in the curve outward direction (Yes in step S222), the latch is performed. The steering angle updating unit 10b latches the corrected steering angle (step S223). That is, in order to update the latch steering angle, the corrected steering angle at that time is substituted for the value of the latch steering angle (latch steering angle=corrected steering angle).

道路のカーブ曲率が閾値以上かつ指令操舵反力トルクがカーブ外側方向に閾値以上ではない場合(ステップS222でNo)、ラッチ操舵角更新部10bは、補正操舵角が、ラッチ操舵角に既定の操舵角ヒスを加算した操舵角より小さいか判断する(ステップS224)。補正操舵角が、ラッチ操舵角に操舵角ヒスを加算した操舵角より小さくない場合(ステップS224でNo)、ラッチ操舵角更新部10bは、何もしない。 When the curve curvature of the road is equal to or greater than the threshold value and the command steering reaction force torque is not equal to or greater than the threshold value in the curve outward direction (No in step S222), the latch steering angle update unit 10b determines that the corrected steering angle is the steering wheel that is the predetermined steering angle. It is determined whether the steering angle is smaller than the sum of the angle hiss (step S224). When the corrected steering angle is not smaller than the steering angle obtained by adding the steering angle hiss to the latch steering angle (No in step S224), the latch steering angle updating unit 10b does nothing.

補正操舵角が、ラッチ操舵角に操舵角ヒスを加算した操舵角より小さい場合(ステップS224でYes)、ラッチ操舵角更新部10bは、補正操舵角から操舵角ヒスを減じた操舵角をラッチする(ステップS225)。これにより、ラッチ操舵角は更新され、補正操舵角から操舵角ヒスを減じた操舵角となる(ラッチ操舵角=補正操舵角−操舵角ヒス)。 When the corrected steering angle is smaller than the steering angle obtained by adding the steering angle hiss to the latch steering angle (Yes in step S224), the latch steering angle updating unit 10b latches the steering angle obtained by subtracting the steering angle hiss from the corrected steering angle. (Step S225). As a result, the latch steering angle is updated and becomes the steering angle obtained by subtracting the steering angle hiss from the corrected steering angle (latch steering angle=corrected steering angle−steering angle hiss).

(切り替えゲインの演算)
図11は、切り替えゲイン(切り増しゲイン及び切り戻しゲイン)の演算に関するフローチャートである。
切り替えゲイン演算部10cは、切り戻しゲインを設定する(ステップS301)。ここでは、切り戻しゲインに、ラッチ操舵角から補正操舵角を減じた操舵角を、操舵角ヒスで割った値を設定する(切り戻しゲイン=(ラッチ操舵角−補正操舵角)/操舵角ヒス)。
(Calculation of switching gain)
FIG. 11 is a flowchart relating to the calculation of the switching gain (additional gain and reverting gain).
The switching gain calculator 10c sets the switching back gain (step S301). Here, a value obtained by dividing the steering angle obtained by subtracting the corrected steering angle from the latch steering angle by the steering angle hiss is set as the switching back gain (returning gain=(latch steering angle−corrected steering angle)/steering angle hiss ).

切り替えゲイン演算部10cは、切り増しゲインを設定する(ステップS302)。ここでは、切り増しゲインに、1から切り戻しゲインを減じた値を設定する(切り増しゲイン=1−切り戻しゲイン)。
これにより、切り戻しゲインと切り増しゲインとの合計値が1になる範囲内で、切り戻しゲインと切り増しゲインとの値のバランスがとられる。したがって、切り戻しゲイン及び切り増しゲインはそれぞれ0から1の間で変動する。
The switching gain calculator 10c sets the additional gain (step S302). Here, a value obtained by subtracting the cutback gain from 1 is set to the increase gain (additional gain=1−cutback gain).
As a result, the values of the cutback gain and the increase gain are balanced within the range where the total value of the cutback gain and the increase gain is 1. Therefore, the switching back gain and the switching up gain each fluctuate between 0 and 1.

切り替えゲイン演算部10cは、算出結果(切り替えゲイン)を操舵反力制御部20に出力する。ここでは、切り替えゲインは、切り戻しゲインと、切り増しゲインとを示す。すなわち、切り替えゲイン演算部10cは、算出結果(切り替えゲイン)として、切り戻しゲイン及び切り増しゲインを操舵反力制御部20に出力する。このとき、切り替えゲイン演算部10cは、算出結果(切り替えゲイン)として、切り戻しゲイン及び切り増しゲインを、逸脱余裕時間反力マップ演算部25e(図5参照)及び横位置偏差反力マップ演算部26d(図6参照)に出力しても良い。 The switching gain calculator 10c outputs the calculation result (switching gain) to the steering reaction force controller 20. Here, the switching gain indicates a switching back gain and a switching up gain. That is, the switching gain calculation unit 10 c outputs the return steering gain and the additional steering gain to the steering reaction force control unit 20 as the calculation result (switching gain). At this time, the switching gain calculation unit 10c calculates the switching back gain and the additional gain as the calculation result (switching gain), and the deviation margin reaction force map calculation unit 25e (see FIG. 5) and the lateral position deviation reaction force map calculation unit. 26d (see FIG. 6).

(他の実施例:操舵角に相当する情報を用いた切り替えゲインの演算)
上記の説明では、車線維持制御部10は、操舵角を用いて切り替えゲインを算出している。但し、実際には、操舵角に限らず、操舵角に相当する情報を用いて切り替えゲインを算出することも可能である。例えば、操舵角に相当する情報として、ステアリングホイールに発生する操舵トルクや、道路形状から推定される推定ヨーレート(ヨー角の変化速度)と実際に発生している実ヨーレートとの差分等を用いて切り替えゲインを算出しても良い。
(Other embodiment: Calculation of switching gain using information corresponding to steering angle)
In the above description, the lane keeping control unit 10 calculates the switching gain using the steering angle. However, actually, the switching gain can be calculated using not only the steering angle but also information corresponding to the steering angle. For example, as the information corresponding to the steering angle, the steering torque generated in the steering wheel, the difference between the estimated yaw rate (rate of change of the yaw angle) estimated from the road shape and the actual yaw rate actually generated are used. The switching gain may be calculated.

操舵角、操舵トルク、及びヨーレートの差分はいずれも、ステアリングホイールの操舵状態が逸脱方向に大きくなるに従って大きな値となる操舵状態値である。
(a)操舵トルク
操舵角の代わりに操舵トルクを用いて切り替えゲインを算出する場合、上記の説明において、操舵角を操舵トルクと読み替える。操舵角と操舵トルクとは、いずれもステアリングホイール1aの回転の度合いを示す値であるため、互換性がある。例えば、操舵角はステアリングホイール1aの回転角を示し、操舵トルクはステアリングホイール1aの回転方向の力を示す。なお、操舵トルクについては、トルクセンサ1e(図1参照)が操舵トルクを検出し、検出結果を車線維持制御部10に出力するようにしても良い。
The difference between the steering angle, the steering torque, and the yaw rate is a steering state value that increases as the steering state of the steering wheel increases in the departure direction.
(A) Steering torque When the switching gain is calculated using the steering torque instead of the steering angle, the steering angle is read as the steering torque in the above description. Since the steering angle and the steering torque are both values indicating the degree of rotation of the steering wheel 1a, they are compatible with each other. For example, the steering angle indicates the rotation angle of the steering wheel 1a, and the steering torque indicates the force in the rotation direction of the steering wheel 1a. Regarding the steering torque, the torque sensor 1e (see FIG. 1) may detect the steering torque and output the detection result to the lane keeping control unit 10.

(b)推定ヨーレートと実ヨーレートとの差分
操舵角の代わりに推定ヨーレートと実ヨーレートとの差分を用いて切り替えゲインを算出する場合、上記の説明において、操舵角を推定ヨーレートと実ヨーレートとの差分と読み替える。例えば、推定ヨーレートは、車線に沿って道なりに走行していると仮定した場合のヨーレートを表す推定値であり、実ヨーレートは、現在のヨーレートを表す実測値である。推定ヨーレートと実ヨーレートとの差分は、操舵角と同じく、ステアリングホイール1aの操舵に応じて変化する値である。なお、推定ヨーレートについては、目標ヨーレート演算部32g(図17参照)が目標ヨーレートを算出し、算出結果を推定ヨーレートとして車線維持制御部10に出力するようにしても良い。また、実ヨーレートについては、各種センサ7の1つとして更にヨーレートセンサ7d(図示せず)を設け、このヨーレートセンサ7dが車両Aのヨーレートを検出し、検出結果を実ヨーレートとして車線維持制御部10に出力するようにしても良い。
(B) Difference between estimated yaw rate and actual yaw rate When the switching gain is calculated using the difference between the estimated yaw rate and the actual yaw rate instead of the steering angle, in the above description, the steering angle is calculated as the difference between the estimated yaw rate and the actual yaw rate. Read as For example, the estimated yaw rate is an estimated value that represents the yaw rate on the assumption that the vehicle is traveling along the lane along the road, and the actual yaw rate is an actual measured value that represents the current yaw rate. The difference between the estimated yaw rate and the actual yaw rate is a value that changes according to the steering of the steering wheel 1a, like the steering angle. Regarding the estimated yaw rate, the target yaw rate calculation unit 32g (see FIG. 17) may calculate the target yaw rate and output the calculation result as the estimated yaw rate to the lane keeping control unit 10. Regarding the actual yaw rate, a yaw rate sensor 7d (not shown) is further provided as one of the various sensors 7, the yaw rate sensor 7d detects the yaw rate of the vehicle A, and the detection result is used as the actual yaw rate to control the lane keeping control unit 10 You may make it output to.

(切り替えゲインの適用)
図12は、切り替えゲインの適用に関するフローチャートである。なお、切り替えゲインの適用は、逸脱余裕時間反力マップ演算部25e(図5参照)及び横位置偏差反力マップ演算部26d(図6参照)のそれぞれにおいて実施するが、使用するマップと情報(逸脱余裕時間、横位置偏差)が異なる点以外は、基本的に共通である。
(Application of switching gain)
FIG. 12 is a flowchart regarding application of switching gain. The application of the switching gain is performed in each of the deviation margin time reaction force map calculation unit 25e (see FIG. 5) and the lateral position deviation reaction force map calculation unit 26d (see FIG. 6). Except for the difference in deviation margin time and lateral position deviation), they are basically common.

逸脱余裕時間反力マップ演算部25e及び横位置偏差反力マップ演算部26dの各々は、切り戻しゲインを切り戻し側(逸脱回避側)のマップに乗じて切り戻し操舵反力トルクを算出する(ステップS401)。
例えば、逸脱余裕時間反力マップ演算部25eは、逸脱余裕時間を用いて、図13又は図14に示す切り戻し側(逸脱回避側)の逸脱余裕時間−反力変換マップ(第1の逸脱回避側マップ)から逸脱余裕時間に応じた操舵反力トルクを取得し、逸脱余裕時間に応じた操舵反力トルクに切り戻しゲインを乗じて、逸脱余裕時間に応じた切り戻し操舵反力トルクを算出する。
また、横位置偏差反力マップ演算部26dは、横位置偏差を用いて、図15又は図16に示す切り戻し側(逸脱回避側)の横位置偏差−反力変換マップ(第2の逸脱回避側マップ)から横位置偏差に応じた操舵反力トルクを取得し、横位置偏差に応じた操舵反力トルクに切り戻しゲインを乗じて、横位置偏差に応じた切り戻し操舵反力トルクを算出する。
Each of the deviation margin reaction force map calculation unit 25e and the lateral position deviation reaction force map calculation unit 26d multiplies the cutback gain by the map on the cutback side (departure avoidance side) to calculate the cutback steering reaction force torque ( Step S401).
For example, the departure margin time reaction force map computing unit 25e uses the departure margin time to detour margin side-reaction force conversion map (first departure avoidance avoidance side) on the switching back side (departure avoidance side) shown in FIG. 13 or 14. The steering reaction force torque according to the deviation allowance time is acquired from the side map), and the steering reaction force torque according to the deviation allowance time is multiplied by the cutback gain to calculate the steering return steering reaction torque according to the deviation allowance time. To do.
Further, the lateral position deviation reaction force map calculation unit 26d uses the lateral position deviation to perform the lateral position deviation-reaction force conversion map (second deviation avoidance) on the cutback side (deviation avoidance side) shown in FIG. 15 or 16. The steering reaction force torque according to the lateral position deviation is acquired from the side map), and the steering reaction force torque according to the lateral position deviation is multiplied by the cutback gain to calculate the steering return steering reaction torque according to the lateral position deviation. To do.

逸脱余裕時間反力マップ演算部25e及び横位置偏差反力マップ演算部26dの各々は、切り増しゲインを切り増し側(逸脱側)のマップに乗じて切り増し操舵反力トルクを算出する(ステップS402)。
例えば、逸脱余裕時間反力マップ演算部25eは、逸脱余裕時間を用いて、図13又は図14に示す切り増し側(逸脱側)の逸脱余裕時間−反力変換マップ(第1の逸脱側マップ)から逸脱余裕時間に応じた操舵反力トルクを取得し、逸脱余裕時間に応じた操舵反力トルクに切り増しゲインを乗じて、逸脱余裕時間に応じた切り増し操舵反力トルクを算出する。
また、横位置偏差反力マップ演算部26dは、横位置偏差を用いて、図15又は図16に示す切り増し側(逸脱側)の横位置偏差−反力変換マップ(第2の逸脱側マップ)から横位置偏差に応じた転舵角を取得し、横位置偏差に応じた転舵角に切り増しゲインを乗じて、横位置偏差に応じた切り増し操舵反力トルクを算出する。
Each of the deviation margin reaction force map calculation unit 25e and the lateral position deviation reaction force map calculation unit 26d multiplies the additional gain by the additional map (departure side) to calculate the additional steering reaction torque (step). S402).
For example, the departure margin time reaction force map calculating unit 25e uses the departure margin time to deviate margin time-reaction force conversion map (first departure side map) on the rounded side (departure side) shown in FIG. 13 or FIG. ), the steering reaction force torque corresponding to the departure margin time is acquired, and the steering reaction force torque corresponding to the departure margin time is multiplied by the gain to calculate the steering reaction force torque according to the departure margin time.
In addition, the lateral position deviation reaction force map calculation unit 26d uses the lateral position deviation to perform a lateral position deviation-reaction force conversion map (second deviation side map) on the additional side (departure side) shown in FIG. 15 or 16. ), the steering angle according to the lateral position deviation is acquired, and the steering angle according to the lateral position deviation is multiplied by the gain to calculate the steering steering reaction force torque according to the lateral position deviation.

逸脱余裕時間反力マップ演算部25e及び横位置偏差反力マップ演算部26dの各々は、切り戻し操舵反力トルクに切り増し操舵反力トルクを加算して合計操舵反力トルクを算出する(ステップS403)。
例えば、逸脱余裕時間反力マップ演算部25eは、逸脱余裕時間に応じた切り戻し操舵反力トルクに、逸脱余裕時間に応じた切り増し操舵反力トルクを加算して、逸脱余裕時間に応じた合計操舵反力トルクを算出する。
また、横位置偏差反力マップ演算部26dは、横位置偏差に応じた切り戻し操舵反力トルクに、横位置偏差に応じた切り増し操舵反力トルクを加算して、横位置偏差に応じた合計操舵反力トルクを算出する。
Each of the deviation margin reaction force map calculation unit 25e and the lateral position deviation reaction force map calculation unit 26d calculates the total steering reaction force torque by adding the steering reaction force torque to the return steering steering reaction torque. S403).
For example, the departure margin time reaction force map calculation unit 25e adds the increased steering reaction force torque according to the departure margin time to the turning-back steering reaction force torque according to the departure margin time, and responds to the departure margin time. Calculate the total steering reaction torque.
In addition, the lateral position deviation reaction force map calculation unit 26d adds the increased steering reaction force torque corresponding to the lateral position deviation to the turning-back steering reaction torque corresponding to the lateral position deviation to obtain the lateral position deviation. Calculate the total steering reaction torque.

逸脱余裕時間反力マップ演算部25e及び横位置偏差反力マップ演算部26dの各々は、加算結果(合計操舵反力トルク)を指令値として、反力選択部24c(図4参照)に出力する(ステップS404)。
例えば、逸脱余裕時間反力マップ演算部25eは、逸脱余裕時間に応じた合計操舵反力トルクを、逸脱余裕時間に応じた反力として、反力選択部24c(図4参照)に出力する。
また、横位置偏差反力マップ演算部26dは、横位置偏差に応じた合計操舵反力トルクを、横位置偏差に応じた反力として、反力選択部24c(図4参照)に出力する。
Each of the deviation margin reaction force map calculation unit 25e and the lateral position deviation reaction force map calculation unit 26d outputs the addition result (total steering reaction force torque) to the reaction force selection unit 24c (see FIG. 4) as a command value. (Step S404).
For example, the departure margin time reaction force map calculator 25e outputs the total steering reaction force torque corresponding to the departure margin time to the reaction force selector 24c (see FIG. 4) as a reaction force corresponding to the departure margin time.
Further, the lateral position deviation reaction force map calculation unit 26d outputs the total steering reaction force torque corresponding to the lateral position deviation to the reaction force selection unit 24c (see FIG. 4) as a reaction force corresponding to the lateral position deviation.

このように、逸脱余裕時間反力マップ演算部25e及び横位置偏差反力マップ演算部26dの各々は、横位置に応じて、切り戻し側(逸脱回避側)と切り増し側(逸脱側)との2種類のマップのマップ引きを行って操舵反力トルクを取得し、切り戻し側(逸脱回避側)の操舵反力トルクに切り戻しゲインを乗じ、切り増し側(逸脱側)の操舵反力トルクに切り増しゲインを乗じて、それらの乗算結果を合算する。すなわち、切り戻しゲインと切り増しゲインとを用いて、2種類のマップのブレンド(混合)を行う。 In this way, each of the deviation margin reaction force map calculation unit 25e and the lateral position deviation reaction force map calculation unit 26d is classified into a return-back side (departure avoidance side) and a surplus side (departure side) according to the lateral position. The steering reaction force torque is obtained by performing map subtraction of the two types of maps, and the steering reaction force torque on the cutback side (departure avoidance side) is multiplied by the cutback gain to obtain the steering reaction force on the increased side (departure side). The torque is multiplied by the gain and the results of these multiplications are summed. That is, blending (mixing) of two types of maps is performed using the cutback gain and the cutup gain.

(マップの遷移)
図13は、車両Aが左方向の車線端部に寄っている場合の逸脱余裕時間−反力変換マップの説明図である。図14は、車両Aが右方向の車線端部に寄っている場合の逸脱余裕時間−反力変換マップの説明図である。図15は、車両Aが左方向の車線端部に寄っている場合の横位置偏差−反力変換マップの説明図である。図16は、車両Aが右方向の車線端部に寄っている場合の横位置偏差−反力変換マップの説明図である。
(Map transition)
FIG. 13 is an explanatory diagram of a departure margin time-reaction force conversion map when the vehicle A is leaning toward the left lane end. FIG. 14 is an explanatory diagram of a departure margin time-reaction force conversion map when the vehicle A is approaching the right lane end. FIG. 15 is an explanatory diagram of a lateral position deviation-reaction force conversion map when the vehicle A is leaning toward the left lane end. FIG. 16 is an explanatory diagram of a lateral position deviation-reaction force conversion map when the vehicle A is leaning toward the right lane end.

図13〜図16において、本実施形態に係る車線維持支援装置は、運転者がステアリングホイール1aを切って車線中央から車線端部に寄っていく時(図中のX点)には、切り増し側(逸脱側)のマップに基づいて反力を算出する。具体的には、切り増し側(逸脱側)のマップから得られる反力に切り増しゲインを乗じた値と、切り戻し側(逸脱回避側)のマップから得られる反力に切り戻しゲインを乗じた値とを合算して反力を算出しているが、この間には切り増しゲインが1であり、切り戻しゲインが0であるため、結果として切り増し側(逸脱側)のマップから得られる反力のみ使用することになる。 13 to 16, the lane keeping assist device according to the present embodiment, when the driver turns the steering wheel 1a and approaches from the center of the lane to the end of the lane (point X in the figure), the additional turning is performed. The reaction force is calculated based on the map on the side (departure side). Specifically, multiply the reaction force obtained from the map on the additional side (departure side) by the additional gain, and multiply the reaction force obtained from the map on the reverting side (departure avoidance side) by the reverting gain. The reaction force is calculated by adding up with the value obtained during this period, but during this period, the additional gain is 1 and the return gain is 0, and as a result, it is obtained from the additional map (departure side). Only reaction force will be used.

次に、本実施形態に係る車線維持支援装置は、運転者がステアリングホイール1aを切るのを止めた時(図中のY点)、反力制御によりステアリングホイール1aが少し戻りつつ、切り増し側(逸脱側)のマップから切り戻し側(逸脱回避側)のマップに遷移する(図中のY点→Z点)。具体的には、切り増し側(逸脱側)のマップから得られる反力に切り増しゲインを乗じた値と、切り戻し側(逸脱回避側)のマップから得られる反力に切り戻しゲインを乗じた値とを合算して反力を算出しているが、この間に、切り増しゲインが1から0に変化し、切り戻しゲインが0から1に変化するため、合算した反力において、切り増し側(逸脱側)のマップから得られる反力の占める割合は徐々に小さくなっていき、切り戻し側(逸脱回避側)のマップから得られる反力の占める割合は徐々に大きくなっていく。 Next, when the driver stops turning the steering wheel 1a (point Y in the figure), the lane keeping assist device according to the present embodiment causes the steering wheel 1a to slightly return by the reaction force control while increasing the turning side. The map shifts from the (departure side) map to the cutback side (deviation avoidance side) map (point Y→point Z in the figure). Specifically, multiply the reaction force obtained from the map on the additional side (departure side) by the additional gain, and multiply the reaction force obtained from the map on the reverting side (departure avoidance side) by the reverting gain. However, the additional gain changes from 1 to 0 and the reverting gain changes from 0 to 1 during this period. The proportion of reaction force obtained from the side (departure side) map gradually decreases, and the proportion of reaction force obtained from the cutback side (departure avoidance side) map gradually increases.

次に、本実施形態に係る車線維持支援装置は、運転者がステアリングホイール1aを切って車線端部から車線中央に戻っていく時(図中のZ点)には、切り戻し側(逸脱回避側)のマップに基づいて反力を算出する。具体的には、切り増し側(逸脱側)のマップから得られる反力に切り増しゲインを乗じた値と、切り戻し側(逸脱回避側)のマップから得られる反力に切り戻しゲインを乗じた値とを合算して反力を算出しているが、この間には切り増しゲインが0であり、切り戻しゲインが1であるため、結果として切り戻し側(逸脱回避側)のマップから得られる反力のみ使用することになる。 Next, when the driver turns the steering wheel 1a and returns from the end of the lane to the center of the lane (point Z in the figure), the lane keeping assist device according to the present embodiment switches to the return side (departure avoidance). The reaction force is calculated based on the map of (side). Specifically, multiply the reaction force obtained from the map on the additional side (departure side) by the additional gain, and multiply the reaction force obtained from the map on the reverting side (departure avoidance side) by the reverting gain. Value is added to calculate the reaction force, but during this period, the additional gain is 0 and the return gain is 1, so the result is obtained from the map on the return side (deviation avoidance side). Only the reaction force that is applied will be used.

本実施形態によれば、逸脱側に対する反力を大きく設計しても、逸脱回避側では反力が弱まるため、挙動への影響が少ない。そのため、大きな反力伝達と、少ない挙動への影響との両立が可能となる。また、逸脱余裕時間−反力変換マップと横位置偏差−反力変換マップとは、同じ切り替えゲインを用いて切り替えているため、逸脱余裕時間−反力変換マップの切り替えと、横位置偏差−反力変換マップの切り替えとは、同時に行うことになる。 According to the present embodiment, even if the reaction force on the departure side is designed to be large, the reaction force is weakened on the departure avoidance side, so that the behavior is less affected. Therefore, it is possible to achieve both large reaction force transmission and small influence on behavior. Further, since the departure margin time-reaction force conversion map and the lateral position deviation-reaction force conversion map are switched using the same switching gain, the departure margin time-reaction force conversion map and the lateral position deviation-reaction force map are switched. Switching of force conversion maps will be performed at the same time.

(転舵制御部30の構成)
図17は、転舵制御部30の構成例を表すブロック図である。
図17に示すように、転舵制御部30は、SBW指令転舵角演算部31と、外乱抑制指令転舵角演算部32と、加算器30aとを備える。
SBW指令転舵角演算部31は、操舵角センサ1d及び車速センサ7aが出力した検出結果(操舵角、車速)に基づいて、ステアリングホイール1aの操舵に応じた左右前輪5FL、5FRの転舵角とするための転舵角(SBW指令転舵角)を算出する。そして、SBW指令転舵角演算部31は、算出結果を加算器30aに出力する。
(Structure of the steering control unit 30)
FIG. 17 is a block diagram showing a configuration example of the steering control unit 30.
As shown in FIG. 17, the steering control unit 30 includes an SBW command steering angle calculation unit 31, a disturbance suppression command steering angle calculation unit 32, and an adder 30a.
The SBW command steering angle calculation unit 31 determines the steering angles of the left and right front wheels 5FL, 5FR according to the steering of the steering wheel 1a based on the detection results (steering angle, vehicle speed) output by the steering angle sensor 1d and the vehicle speed sensor 7a. Then, the steering angle (SBW command steering angle) is calculated. Then, the SBW command steering angle calculation unit 31 outputs the calculation result to the adder 30a.

外乱抑制指令転舵角演算部32は、車速センサ7a及び映像処理部4aが出力した検出結果(車速、白線情報)に基づいて、SBW指令転舵角演算部31が出力した算出結果(SBW指令転舵角)を補正するための転舵角(外乱抑制指令転舵角)を算出する。例えば、外乱抑制指令転舵角は、外乱により発生したヨー角(後述)等を低減するための転舵角である。そして、外乱抑制指令転舵角演算部32は、算出結果を加算器30aに出力する。 The disturbance suppression command turning angle calculation unit 32 outputs the calculation result output by the SBW command turning angle calculation unit 31 (SBW command based on the detection results (vehicle speed, white line information) output by the vehicle speed sensor 7a and the image processing unit 4a. A steering angle (disturbance suppression command steering angle) for correcting the steering angle is calculated. For example, the disturbance suppression command turning angle is a turning angle for reducing a yaw angle (described later) generated by the disturbance. Then, the disturbance suppression command steering angle calculation unit 32 outputs the calculation result to the adder 30a.

加算器30aは、SBW指令転舵角演算部31が出力した算出結果(SBW指令転舵角)に外乱抑制指令転舵角演算部32が出力した算出結果(外乱抑制指令転舵角)を加算する。これにより、加算器30aは、SBW指令転舵角を外乱抑制指令転舵角で補正する。そして、加算器30aは、加算結果を、指令転舵角(転舵指令)として転舵モータ用電流ドライバ9bに出力する。 The adder 30a adds the calculation result (disturbance suppression command steering angle) output by the disturbance suppression command steering angle calculation unit 32 to the calculation result (SBW command steering angle) output by the SBW command steering angle calculation unit 31. To do. As a result, the adder 30a corrects the SBW command steering angle with the disturbance suppression command steering angle. Then, the adder 30a outputs the addition result as a command steering angle (steering command) to the steering motor current driver 9b.

(外乱抑制指令転舵角演算部32の構成)
図18は、外乱抑制指令転舵角演算部32の構成例を表すブロック図である。
図18に示すように、外乱抑制指令転舵角演算部32は、ヨー角演算部32aと、曲率演算部32bと、横位置演算部32cと、ヨー角に応じた反発力演算部33と、横位置に応じた反発力演算部34と、加算器32dと、目標ヨーモーメント演算部32eと、目標ヨー加速度演算部32fと、目標ヨーレート演算部32gと、指令転舵角演算部32hと、リミッタ処理部32iとを備える。
(Structure of disturbance suppression command steering angle calculation unit 32)
FIG. 18 is a block diagram showing a configuration example of the disturbance suppression command turning angle calculation unit 32.
As shown in FIG. 18, the disturbance suppression command turning angle calculation unit 32 includes a yaw angle calculation unit 32a, a curvature calculation unit 32b, a lateral position calculation unit 32c, and a repulsion force calculation unit 33 according to the yaw angle. The repulsive force calculation unit 34 according to the lateral position, the adder 32d, the target yaw moment calculation unit 32e, the target yaw acceleration calculation unit 32f, the target yaw rate calculation unit 32g, the command steering angle calculation unit 32h, and the limiter. And a processing unit 32i.

ヨー角演算部32aは、車速センサ7a及び映像処理部4aが出力した検出結果(車速、白線情報)に基づいて、前方注視点でのヨー角を算出する。前方注視点でのヨー角としては、例えば、設定時間(例えば、0.5秒)後に走行車線(道路白線)と車両A進行方向とのなす角度がある。そして、ヨー角演算部32aは、算出結果をヨー角に応じた反発力演算部33及び横位置に応じた反発力演算部34に出力する。 The yaw angle calculation unit 32a calculates the yaw angle at the front gazing point based on the detection results (vehicle speed and white line information) output by the vehicle speed sensor 7a and the image processing unit 4a. The yaw angle at the forward gazing point is, for example, an angle formed by the traveling lane (white road line) and the traveling direction of the vehicle A after a set time (for example, 0.5 seconds). Then, the yaw angle calculation unit 32a outputs the calculation result to the repulsion force calculation unit 33 according to the yaw angle and the repulsion force calculation unit 34 according to the lateral position.

曲率演算部32bは、車速センサ7a及び映像処理部4aが出力した検出結果(車速、白線情報)に基づいて、前方注視点での道路白線の曲率を算出する。前方注視点での道路白線の曲率としては、例えば、設定時間(0.5秒)後の車両A位置の走行車線(道路白線)の曲率がある。そして、曲率演算部32bは、算出結果をヨー角に応じた反発力演算部33及び横位置に応じた反発力演算部34に出力する。 The curvature calculation unit 32b calculates the curvature of the road white line at the front gazing point based on the detection results (vehicle speed and white line information) output by the vehicle speed sensor 7a and the image processing unit 4a. The curvature of the road white line at the forward gazing point is, for example, the curvature of the traveling lane (road white line) at the position of the vehicle A after the set time (0.5 seconds). Then, the curvature calculation unit 32b outputs the calculation result to the repulsion force calculation unit 33 according to the yaw angle and the repulsion force calculation unit 34 according to the lateral position.

横位置演算部32cは、映像処理部4aが出力した検出結果(白線情報)に基づいて、前方注視点での車両Aから道路白線までの距離(横位置)(以下、前方注視点での横位置とも呼ぶ)を算出する。前方注視点での横位置としては、例えば、設定時間(0.5秒)後の車両A位置から道路白線までの距離(横位置)がある。そして、横位置演算部32cは、算出結果を横位置に応じた反発力演算部34に出力する。 The lateral position calculation unit 32c calculates the distance (horizontal position) from the vehicle A at the front gazing point to the road white line (hereinafter, the lateral position at the front gazing point) based on the detection result (white line information) output by the video processing unit 4a. (Also called position). The lateral position at the forward gazing point is, for example, the distance (horizontal position) from the vehicle A position to the road white line after a set time (0.5 seconds). Then, the lateral position calculation unit 32c outputs the calculation result to the repulsive force calculation unit 34 according to the lateral position.

ヨー角に応じた反発力演算部33は、ヨー角演算部32a、曲率演算部32b、及び車速センサ7aが出力した検出結果(前方注視点でのヨー角、前方注視点での道路白線の曲率、車速)に基づいて、ヨー角フィードバック制御(転舵制御)を行う。ヨー角フィードバック制御では、外乱により発生したヨー角を低減するための車両Aの反発力(以下、ヨー角に応じた反発力とも呼ぶ)を算出する。これにより、ヨー角フィードバック制御では、前方注視点でのヨー角に基づいて当該ヨー角が低減する方向へ左右前輪5FL、5FRの転舵角を制御する。そして、ヨー角に応じた反発力演算部33は、算出結果を加算器32dに出力する。ヨー角に応じた反発力演算部33の詳細は後述する。 The repulsive force calculation unit 33 according to the yaw angle detects the detection results output by the yaw angle calculation unit 32a, the curvature calculation unit 32b, and the vehicle speed sensor 7a (the yaw angle at the front gazing point, the curvature of the road white line at the front gazing point). , Vehicle speed), yaw angle feedback control (steering control) is performed. In the yaw angle feedback control, the repulsive force of the vehicle A for reducing the yaw angle generated by the disturbance (hereinafter, also referred to as the repulsive force corresponding to the yaw angle) is calculated. As a result, in the yaw angle feedback control, the steered angles of the left and right front wheels 5FL and 5FR are controlled in the direction in which the yaw angle is reduced based on the yaw angle at the forward gazing point. Then, the repulsive force calculation unit 33 according to the yaw angle outputs the calculation result to the adder 32d. Details of the repulsive force calculation unit 33 according to the yaw angle will be described later.

横位置に応じた反発力演算部34は、ヨー角演算部32a、曲率演算部32b、横位置演算部32c、及び車速センサ7aが出力した検出結果(前方注視点でのヨー角、前方注視点での道路白線の曲率、前方注視点での横位置、車速)に基づいて、横位置フィードバック制御(転舵角制御)を行う。横位置フィードバック制御では、外乱により発生した横位置変化を低減するための車両Aの反発力(以下、横位置に応じた反発力とも呼ぶ)を算出する。これにより、横位置フィードバック制御では、前方注視点での横位置に基づいて車両Aが走行車線の中央方向、つまり、横位置が低減する方向へ左右前輪5FL、5FRの転舵角を制御する。そして、横位置に応じた反発力演算部34は、算出結果を加算器32dに出力する。横位置に応じた反発力演算部34の詳細は後述する。 The repulsive force calculation unit 34 according to the lateral position detects the yaw angle calculation unit 32a, the curvature calculation unit 32b, the lateral position calculation unit 32c, and the detection results output by the vehicle speed sensor 7a (the yaw angle at the front gazing point, the front gazing point). The lateral position feedback control (steering angle control) is performed based on the curvature of the road white line at, the lateral position at the forward gazing point, and the vehicle speed. In the lateral position feedback control, a repulsive force of the vehicle A (hereinafter, also referred to as a repulsive force corresponding to a lateral position) for reducing a lateral position change caused by a disturbance is calculated. Thus, in the lateral position feedback control, the vehicle A controls the steered angles of the left and right front wheels 5FL, 5FR in the central direction of the traveling lane, that is, in the direction in which the lateral position is reduced, based on the lateral position at the forward gazing point. Then, the repulsive force calculation unit 34 according to the lateral position outputs the calculation result to the adder 32d. Details of the repulsive force calculation unit 34 according to the lateral position will be described later.

加算器32dは、ヨー角に応じた反発力演算部33が出力した算出結果(ヨー角に応じた反発力)、及び横位置に応じた反発力演算部34が出力した算出結果(横位置に応じた反発力)を加算する。そして、加算器32dは、加算結果(以下、横方向反発力とも呼ぶ)を目標ヨーモーメント演算部32eに出力する。 The adder 32d outputs the calculation result output by the repulsion force calculation unit 33 according to the yaw angle (repulsion force according to the yaw angle) and the calculation result output by the repulsion force calculation unit 34 according to the lateral position (at the lateral position). Repulsive force according to) is added. Then, the adder 32d outputs the addition result (hereinafter, also referred to as lateral repulsion force) to the target yaw moment calculation unit 32e.

目標ヨーモーメント演算部32eは、加算器32dが出力した算出結果(横方向反発力)に基づいて、目標ヨーモーメントを算出する。具体的には、目標ヨーモーメント演算部32eは、横方向反発力、ホイールベースWHEELBASE、後輪軸重、及び前輪軸重に基づき、下記(1)式に従って目標ヨーモーメントMを算出する。そして、目標ヨーモーメント演算部32eは、算出結果を目標ヨー加速度演算部32fに出力する。
=横方向反発力×(後輪軸重/(前輪軸重+後輪軸重))×WHEELBASE ……(1)
The target yaw moment calculation unit 32e calculates the target yaw moment based on the calculation result (lateral repulsion force) output by the adder 32d. Specifically, the target yaw moment calculation unit 32e calculates the target yaw moment M * according to the following equation (1) based on the lateral repulsion force, the wheel base WHEELBASE, the rear wheel axle weight, and the front wheel axle weight. Then, the target yaw moment calculation unit 32e outputs the calculation result to the target yaw acceleration calculation unit 32f.
M * = Lateral repulsive force x (rear wheel axle load/(front wheel axle load + rear wheel axle load)) x WHEELBASE (1)

目標ヨー加速度演算部32fは、目標ヨーモーメント演算部32eが出力した算出結果(目標ヨーモーメント)に基づいて、目標ヨー加速度を算出する。具体的には、目標ヨー加速度演算部32fは、目標ヨーモーメントに予め定めたヨー慣性モーメント係数を乗算する。そして、目標ヨー加速度演算部32fは、乗算結果を目標ヨー加速度として目標ヨーレート演算部32gに出力する。
目標ヨーレート演算部32gは、目標ヨー加速度演算部32fが出力した算出結果(目標ヨー加速度)に基づいて、目標ヨーレートを算出する。具体的には、目標ヨーレート演算部32gは、目標ヨー加速度に車頭時間を乗算する。そして、目標ヨーレート演算部32gは、乗算結果を目標ヨーレートとして指令転舵角演算部32hに出力する。
The target yaw acceleration calculation unit 32f calculates the target yaw acceleration based on the calculation result (target yaw moment) output by the target yaw moment calculation unit 32e. Specifically, the target yaw acceleration calculator 32f multiplies the target yaw moment by a predetermined yaw moment of inertia coefficient. Then, the target yaw acceleration calculation unit 32f outputs the multiplication result as the target yaw acceleration to the target yaw rate calculation unit 32g.
The target yaw rate calculation unit 32g calculates the target yaw rate based on the calculation result (target yaw acceleration) output by the target yaw acceleration calculation unit 32f. Specifically, the target yaw rate calculation unit 32g multiplies the target yaw acceleration by the headway time. Then, the target yaw rate calculation unit 32g outputs the multiplication result to the command steering angle calculation unit 32h as the target yaw rate.

指令転舵角演算部32hは、目標ヨーレート演算部32g及び車速センサ7aが出力した検出結果(目標ヨーレート、車速)に基づいて、外乱抑制指令転舵角を算出する。具体的には、指令転舵角演算部32hは、目標ヨーレートφ、車速V、ホイールベースWHEELBASE、及び車両Aの特性速度Vchに基づき、下記(2)式に従って外乱抑制指令転舵角δstを算出する。ここで、車両Aの特性速度Vchとしては、例えば、既知のアッカーマン方程式の中の、車両Aのセルフステアリング特性を表すパラメータがある。そして、指令転舵角演算部32hは、算出結果をリミッタ処理部32iに出力する。
δst=(φ×WHEELBASE×(1+(V/Vch))×180)/(V×MPI) ……(2)
なお、MPIは、予め定めた係数である。
The command steering angle calculation unit 32h calculates the disturbance suppression command steering angle based on the detection results (target yaw rate, vehicle speed) output by the target yaw rate calculation unit 32g and the vehicle speed sensor 7a. Specifically, the command turning angle calculation unit 32h uses the target yaw rate φ * , the vehicle speed V, the wheelbase WHEELBASE, and the characteristic speed Vch of the vehicle A according to the following equation (2) to determine the disturbance suppression command turning angle δst *. To calculate. Here, as the characteristic speed Vch of the vehicle A, there is, for example, a parameter representing the self-steering characteristic of the vehicle A in the known Ackermann equation. Then, the command turning angle calculation unit 32h outputs the calculation result to the limiter processing unit 32i.
δst * =(φ * ×WHEELBASE×(1+(V/Vch) 2 )×180)/(V×MPI) (2)
MPI is a predetermined coefficient.

リミッタ処理部32iは、指令転舵角演算部32hが出力した算出結果(外乱抑制指令転舵角δst)の最大値及び変化率の上限を制限する。外乱抑制指令転舵角δstの最大値は、コンベンショナルな操舵装置(操舵部1と転舵部2とが機械的に接続された操舵装置)において、ステアリングホイール1aの操舵角が中立位置付近の遊びの角度範囲(例えば、左右3度)にあるときの当該遊びの範囲に対応する左右前輪5FL、5FRの転舵角範囲(例えば、左右0.2度)とする。そして、リミッタ処理部32iは、制限後の外乱抑制指令転舵角δstを加算器30a(図17参照)に出力する。 The limiter processing unit 32i limits the maximum value of the calculation result (the disturbance suppression command steering angle δst * ) output by the command steering angle calculation unit 32h and the upper limit of the rate of change. The maximum value of the disturbance suppression command turning angle δst * is that the steering angle of the steering wheel 1a is in the vicinity of the neutral position in a conventional steering device (a steering device in which the steering unit 1 and the steering unit 2 are mechanically connected). The steering angle range (for example, 0.2 degrees left and right) of the left and right front wheels 5FL and 5FR corresponding to the range of the play when it is in the play angle range (for example, left and right 3 degrees). Then, the limiter processing unit 32i outputs the limited disturbance suppression command turning angle δst * to the adder 30a (see FIG. 17).

(ヨー角に応じた反発力演算部33の構成)
図19は、ヨー角に応じた反発力演算部33の構成例を表すブロック図である。
図19に示すように、ヨー角に応じた反発力演算部33は、上下限リミッタ33aと、設定ゲイン乗算部33bと、車速補正ゲイン乗算部33cと、曲率補正ゲイン乗算部33dと、乗算器33eとを備える。
(Structure of repulsive force calculation unit 33 according to yaw angle)
FIG. 19 is a block diagram showing a configuration example of the repulsive force calculation unit 33 according to the yaw angle.
As shown in FIG. 19, the repulsive force calculation unit 33 according to the yaw angle includes an upper and lower limit limiter 33a, a set gain multiplication unit 33b, a vehicle speed correction gain multiplication unit 33c, a curvature correction gain multiplication unit 33d, and a multiplier. 33e.

上下限リミッタ33aは、ヨー角演算部32aが出力した算出結果(前方注視点でのヨー角)に上下限リミッタ処理を行う。上下限リミッタ処理では、例えば、ヨー角が正値の場合(道路白線と車両A進行方向の延長線とが交差するときのヨー角を正とする)には、外乱を抑制可能な設定値以上の値で、且つ、車両Aが振動的となる値及び運転者の操舵によって発生する値未満の正値(上限値。例えば、1度)とする。また、上下限リミッタ処理では、例えば、ヨー角が負の場合には0とする。そして、上下限リミッタ33aは、上下限リミッタ処理後のヨー角を設定ゲイン乗算部33bに出力する。これにより、上下限リミッタ処理後のヨー角は、ヨー角が発生した場合にのみ正値となる。 The upper/lower limit limiter 33a performs an upper/lower limit limiter process on the calculation result (the yaw angle at the forward gazing point) output by the yaw angle calculation unit 32a. In the upper and lower limit limiter processing, for example, when the yaw angle is a positive value (the yaw angle when the road white line and the extension line in the traveling direction of the vehicle A intersect is positive), it is equal to or more than a set value capable of suppressing disturbance. And a positive value (upper limit value, for example, 1 degree) less than a value that causes the vehicle A to vibrate and a value that is generated by the driver's steering. In the upper and lower limit limiter processing, for example, when the yaw angle is negative, it is set to 0. Then, the upper/lower limit limiter 33a outputs the yaw angle after the upper/lower limit limiter processing to the set gain multiplication unit 33b. As a result, the yaw angle after the upper/lower limit limiter processing becomes a positive value only when the yaw angle occurs.

設定ゲイン乗算部33bは、上下限リミッタ33aが出力した算出結果(上下限リミッタ処理後のヨー角)に予め定めた設定ゲインを乗算する。設定ゲインは、例えば、制御量不足を回避しつつ応答性を確保できる値以上の値とする。また、設定ゲインは、車両Aが振動的となる値、及び運転者が操舵角と転舵角との中立ずれを感じる値未満の値とする。そして、設定ゲイン乗算部33bは、乗算結果(以下、上限値乗算後の設定ゲインとも呼ぶ)を乗算器33eに出力する。 The set gain multiplication unit 33b multiplies the calculation result (the yaw angle after the upper/lower limit limiter processing) output by the upper/lower limit limiter 33a by a predetermined set gain. The set gain is, for example, a value that is equal to or greater than a value that can ensure responsiveness while avoiding a lack of control amount. The set gain is set to a value that is less than a value at which the vehicle A becomes oscillatory and a value at which the driver feels a neutral deviation between the steering angle and the steering angle. Then, the set gain multiplication unit 33b outputs the multiplication result (hereinafter, also referred to as the set gain after the upper limit value multiplication) to the multiplier 33e.

車速補正ゲイン乗算部33cは、車速センサ7aが出力した検出結果(車速)に予め定めた車速補正ゲインを乗算する。車速補正ゲインは、例えば、車速が0〜70km/hの範囲で最大値となり、車速70〜130km/hの範囲で車速が大きくなるほど減少し、車速130km/h以上の範囲で最小値(例えば、ほぼ0)となる。そして、車速補正ゲイン乗算部33cは、乗算結果を乗算器33eに出力する。 The vehicle speed correction gain multiplication unit 33c multiplies the detection result (vehicle speed) output by the vehicle speed sensor 7a by a predetermined vehicle speed correction gain. The vehicle speed correction gain has a maximum value in a vehicle speed range of 0 to 70 km/h, decreases as the vehicle speed increases in a vehicle speed range of 70 to 130 km/h, and has a minimum value in a vehicle speed range of 130 km/h or higher (for example, It becomes almost 0). Then, the vehicle speed correction gain multiplication unit 33c outputs the multiplication result to the multiplier 33e.

曲率補正ゲイン乗算部33dは、曲率演算部32bが出力した検出結果(前方注視点での曲率)に予め定めた曲率補正ゲインを乗算する。曲率補正ゲインは、例えば、曲率がR1〜R2(>R1)の範囲で最大値となり、曲率がR2〜R3(>R2)の範囲で曲率が大きくなるほど減少し、曲率R3以上の範囲で最小値(例えば、ほぼ0)となる。そして、曲率補正ゲイン乗算部33dは、乗算結果を乗算器33eに出力する。これにより、曲率補正ゲイン乗算部33dは、前方注視点での曲率が大きいほど乗算結果を低減できる。 The curvature correction gain multiplication unit 33d multiplies the detection result (curvature at the forward gazing point) output by the curvature calculation unit 32b by a predetermined curvature correction gain. The curvature correction gain has a maximum value in the range of curvature R1 to R2 (>R1), decreases as the curvature increases in the range of curvature R2 to R3 (>R2), and has a minimum value in the range of curvature R3 or more. (For example, almost 0). Then, the curvature correction gain multiplication unit 33d outputs the multiplication result to the multiplier 33e. Accordingly, the curvature correction gain multiplication unit 33d can reduce the multiplication result as the curvature at the forward gazing point increases.

乗算器33eは、設定ゲイン乗算部33b、車速補正ゲイン乗算部33c及び曲率補正ゲイン乗算部33dが出力した算出結果を互いに乗算する。そして、乗算結果をヨー角に応じた反発力として加算器32dに出力する。これにより、乗算器33eは、外乱抑制指令転舵角演算部32は、ヨー角が発生した場合にのみヨー角フィードバック制御を行う。
また、乗算器33e(転舵制御部30)は、前方注視点での曲率が大きいほど、ヨー角に応じた反発力の絶対値を低減できる。それゆえ、転舵制御部30は、例えば、車両Aが曲率半径の小さいカーブ(曲路)を走行する場合に、ヨー角に応じた反発力を低減できる。そのため、転舵制御部30は、ヨー角が低減する方向への左右前輪5FL、5FRの転舵を抑制できる。これにより、運転者は、より意図に応じた経路で車両Aを運転できる。
The multiplier 33e multiplies the calculation results output by the set gain multiplication unit 33b, the vehicle speed correction gain multiplication unit 33c, and the curvature correction gain multiplication unit 33d with each other. Then, the multiplication result is output to the adder 32d as a repulsive force corresponding to the yaw angle. As a result, in the multiplier 33e, the disturbance suppression command turning angle calculation unit 32 performs the yaw angle feedback control only when the yaw angle is generated.
Further, the multiplier 33e (the steering control unit 30) can reduce the absolute value of the repulsive force corresponding to the yaw angle as the curvature at the front gazing point is larger. Therefore, the steering control unit 30 can reduce the repulsive force according to the yaw angle when the vehicle A travels on a curve (curved road) having a small radius of curvature, for example. Therefore, the steering control unit 30 can suppress the steering of the left and right front wheels 5FL and 5FR in the direction in which the yaw angle decreases. As a result, the driver can drive the vehicle A on a route that is more in line with the intention.

(横位置に応じた反発力演算部34の構成)
図20は、横位置に応じた反発力演算部34の構成例を表すブロック図である。
図20に示すように、横位置に応じた反発力演算部34は、減算器34aと、上下限リミッタ34bと、距離補正ゲイン乗算部34cと、横位置フィードバックゲイン乗算部34dと、車速補正ゲイン乗算部34eと、曲率補正ゲイン乗算部34fとを備える。
(Structure of the repulsive force calculation unit 34 according to the lateral position)
FIG. 20 is a block diagram showing a configuration example of the repulsive force calculation unit 34 according to the lateral position.
As shown in FIG. 20, the repulsive force calculation unit 34 according to the lateral position includes a subtractor 34a, an upper and lower limit limiter 34b, a distance correction gain multiplication unit 34c, a lateral position feedback gain multiplication unit 34d, and a vehicle speed correction gain. The multiplication unit 34e and the curvature correction gain multiplication unit 34f are provided.

減算器34aは、予め定めた横位置閾値(例えば、90cm)から、横位置演算部32cが出力した算出結果(前方注視点での車両Aから道路白線までの距離(横位置))を減算する。そして、減算器34aは、減算結果(以下、横位置偏差とも呼ぶ)を上下限リミッタ34bに出力する。これにより、横位置偏差は、前方注視点での車両Aから道路白線までの距離が90cmより小さい場合(隣接車線側である場合)にのみ正値となる。 The subtractor 34a subtracts the calculation result (distance (horizontal position) from the vehicle A at the front gazing point to the road white line) output by the lateral position calculation unit 32c from a predetermined lateral position threshold value (for example, 90 cm). .. Then, the subtractor 34a outputs the subtraction result (hereinafter, also referred to as lateral position deviation) to the upper and lower limit limiter 34b. As a result, the lateral position deviation becomes a positive value only when the distance from the vehicle A to the road white line at the forward gazing point is smaller than 90 cm (when it is on the adjacent lane side).

上下限リミッタ34bは、減算器34aが出力した算出結果(横位置偏差)に上下限リミッタ処理を行う。上下限リミッタ処理では、例えば、横位置偏差が正値である場合には予め定めた正値とし、横位置偏差が負値である場合には0とする。そして、上下限リミッタ34bは、上下限リミッタ処理後の横位置偏差を乗算器34gに出力する。これにより、上下限リミッタ処理後の横位置偏差は、前方注視点での車両Aから道路白線までの距離が90cmより小さい場合(隣接車線側である場合)にのみ正値となる。 The upper/lower limit limiter 34b performs an upper/lower limit limiter process on the calculation result (lateral position deviation) output by the subtractor 34a. In the upper and lower limit limiter processing, for example, when the lateral position deviation is a positive value, a predetermined positive value is set, and when the lateral position deviation is a negative value, it is set to 0. Then, the upper/lower limit limiter 34b outputs the lateral position deviation after the upper/lower limit limiter processing to the multiplier 34g. As a result, the lateral position deviation after the upper and lower limit limiter processing becomes a positive value only when the distance from the vehicle A at the front gazing point to the road white line is smaller than 90 cm (on the adjacent lane side).

距離補正ゲイン乗算部34cは、横位置演算部32cが出力した算出結果(前方注視点での横位置)に距離補正ゲインを乗算する。距離補正ゲインは、例えば、車両Aから道路白線までの距離(横位置)がY1〜Y2(>Y1)の範囲で最大値となり、横位置がY2〜Y3(>Y2)の範囲で横位置が大きくなるほど減少し、横位置がY3以上の範囲で最小値になる。そして、距離補正ゲイン乗算部34cは、乗算結果(以下、補正後の道路白線までの距離とも呼ぶ)を横位置フィードバックゲイン乗算部34dに出力する。 The distance correction gain multiplication unit 34c multiplies the calculation result (horizontal position at the forward gazing point) output by the lateral position calculation unit 32c by the distance correction gain. The distance correction gain has a maximum value in the range of the distance (horizontal position) from the vehicle A to the road white line in the range of Y1 to Y2 (>Y1), and the lateral position in the range of Y2 to Y3 (>Y2). It becomes smaller as it becomes larger, and becomes the minimum value in the range where the lateral position is Y3 or more. Then, the distance correction gain multiplication unit 34c outputs the multiplication result (hereinafter also referred to as the corrected distance to the road white line) to the lateral position feedback gain multiplication unit 34d.

横位置フィードバックゲイン乗算部34dは、距離補正ゲイン乗算部34cが出力した算出結果(補正後の道路白線までの距離)に予め定めた横位置フィードバックゲインを乗算する。横位置フィードバックゲインは、例えば、制御量不足を回避しつつ応答性を確保できる設定値以上の値とする。また、横位置フィードバックゲインは、車両Aが振動的になる値、及び運転者が中立ずれを感じる値未満の値とする。更に、横位置フィードバックゲインは、ヨー角フィードバックゲインよりも小さな値とする。そして、横位置フィードバックゲイン乗算部34dは、乗算結果を乗算器34gに出力する。 The lateral position feedback gain multiplication unit 34d multiplies the calculation result (distance to the corrected road white line) output by the distance correction gain multiplication unit 34c by a predetermined lateral position feedback gain. The lateral position feedback gain is set to, for example, a value equal to or larger than a set value capable of ensuring responsiveness while avoiding a shortage of the control amount. Further, the lateral position feedback gain is set to a value that is less than a value at which the vehicle A becomes vibrating and a value at which the driver feels a neutral deviation. Further, the lateral position feedback gain is set to a value smaller than the yaw angle feedback gain. Then, the lateral position feedback gain multiplication unit 34d outputs the multiplication result to the multiplier 34g.

車速補正ゲイン乗算部34eは、車速センサ7aが出力した検出結果(車速)に予め定めた車速補正ゲインを乗算する。車速補正ゲインは、例えば、車速が0〜70km/hの範囲で最大値となり、車速70〜130km/hの範囲で車速が大きくなるほど減少し、車速130km/h以上の範囲で最小値(例えば、0)となる。そして、車速補正ゲイン乗算部34eは、乗算結果を乗算器34gに出力する。 The vehicle speed correction gain multiplication unit 34e multiplies the detection result (vehicle speed) output by the vehicle speed sensor 7a by a predetermined vehicle speed correction gain. The vehicle speed correction gain has a maximum value in a vehicle speed range of 0 to 70 km/h, decreases as the vehicle speed increases in a vehicle speed range of 70 to 130 km/h, and has a minimum value in a vehicle speed range of 130 km/h or higher (for example, 0). Then, the vehicle speed correction gain multiplication unit 34e outputs the multiplication result to the multiplier 34g.

曲率補正ゲイン乗算部34fは、曲率演算部32bが出力した検出結果(前方注視点での曲率)に予め定めた曲率補正ゲインを乗算する。曲率補正ゲインは、例えば、前方注視点での曲率がR1〜R2(>R1)の範囲で最大値となり、曲率がR2〜R3(>R2)の範囲で曲率が大きくなるほど減少し、曲率がR3以上の範囲で最小値(例えば、0)となる。そして、曲率補正ゲイン乗算部34fは、乗算結果を乗算器34gに出力する。 The curvature correction gain multiplication unit 34f multiplies the detection result (curvature at the forward gazing point) output by the curvature calculation unit 32b by a predetermined curvature correction gain. For example, the curvature correction gain has a maximum value in the range of curvatures R1 to R2 (>R1) at the forward gazing point, and decreases as the curvature increases in the range of curvatures R2 to R3 (>R2). It becomes the minimum value (for example, 0) in the above range. Then, the curvature correction gain multiplication unit 34f outputs the multiplication result to the multiplier 34g.

(横位置フィードバック制御の実行領域)
図21は、横位置フィードバック制御の実行領域を表す図である。
乗算器34gは、横位置フィードバックゲイン乗算部34d、車速補正ゲイン乗算部34e、及び曲率補正ゲイン乗算部34fが出力した算出結果を互いに乗算する。そして、乗算器34gは、乗算結果(以下、横位置に応じた反発力とも呼ぶ)を加算器32dに出力する。これにより、外乱抑制指令転舵角演算部32は、前方注視点での車両Aから道路白線までの距離が90cmより小さい場合、つまり、道路白線から90cmの位置より隣接車線側である場合にのみ横位置フィードバック制御を行う。すなわち、図21に示すように、走行車線中央付近は、横位置フィードバック制御を行わない領域(不感帯)となる。
(Execution area of lateral position feedback control)
FIG. 21 is a diagram showing an execution area of the lateral position feedback control.
The multiplier 34g multiplies the calculation results output by the lateral position feedback gain multiplication unit 34d, the vehicle speed correction gain multiplication unit 34e, and the curvature correction gain multiplication unit 34f by each other. Then, the multiplier 34g outputs the multiplication result (hereinafter, also referred to as a repulsive force corresponding to the lateral position) to the adder 32d. As a result, the disturbance suppression command turning angle calculation unit 32 only when the distance from the vehicle A to the road white line at the forward gazing point is smaller than 90 cm, that is, when the distance from the road white line to the adjacent lane is 90 cm. Performs lateral position feedback control. That is, as shown in FIG. 21, the vicinity of the center of the traveling lane is a region (dead zone) where the lateral position feedback control is not performed.

また、乗算器34g(転舵制御部30)は、前方注視点での曲率が大きいほど、横位置に応じた反発力の絶対値を低減できる。それゆえ、転舵制御部30は、例えば、車両Aが曲率半径の小さいカーブを走行する場合に、横位置に応じた反発力を低減できる。そのため、転舵制御部30は、横位置が低減する方向への左右前輪5FL、5FRの転舵を抑制できる。これにより、運転者は、より意図に応じた経路で車両Aを運転できる。 Further, the multiplier 34g (the steering control unit 30) can reduce the absolute value of the repulsive force according to the lateral position as the curvature at the front gazing point is larger. Therefore, the steering control unit 30 can reduce the repulsive force according to the lateral position when the vehicle A travels on a curve having a small radius of curvature, for example. Therefore, the steering control unit 30 can suppress the steering of the left and right front wheels 5FL and 5FR in the direction in which the lateral position is reduced. As a result, the driver can drive the vehicle A on a route that is more in line with the intention.

(本実施形態の効果)
本実施形態によれば、以下のような効果を奏する。
(1)本実施形態に係る車線維持支援装置は、運転者の操舵入力を受けるステアリングホイールと車両の向きを変える転舵輪とが機械的に切り離された車両において、車両の走行状況に応じた操舵反力トルクをステアリングホイールに付与することで、車両の車線維持制御を行う。このとき、車両の走行状況に応じた操舵反力トルクを求める処理として、車両が車線の逸脱方向に近づく際に操舵反力トルクを求める第1処理と、車両が車線の逸脱回避方向に近づく際に操舵反力トルクを求める第2処理と、を別々に実施可能となっている。また、車両の走行状況が同一のとき、第1処理により求められる操舵反力トルクのほうが、第2処理により求められる操舵反力トルクよりも大きい。
(Effect of this embodiment)
According to this embodiment, the following effects are achieved.
(1) A lane keeping assist device according to the present embodiment, in a vehicle in which a steering wheel that receives a steering input from a driver and a steered wheel that changes the direction of the vehicle are mechanically separated, steering according to the traveling state of the vehicle. The lane keeping control of the vehicle is performed by applying the reaction torque to the steering wheel. At this time, as the processing for obtaining the steering reaction force torque according to the traveling state of the vehicle, the first processing for obtaining the steering reaction force torque when the vehicle approaches the departure direction of the lane, and the first processing when the vehicle approaches the departure avoidance direction of the lane The second process for obtaining the steering reaction force torque can be separately performed. Further, when the traveling conditions of the vehicle are the same, the steering reaction force torque obtained by the first process is larger than the steering reaction force torque obtained by the second process.

これにより、操舵入力の切り増し側(逸脱側)での反力と、切り戻し側(逸脱回避側)での反力とを別々に求めることが可能であり、操舵入力の切り増し又は切り戻しに応じて反力制御を切り替えることができる。
また、車両の走行状況が同一のときであっても、運転者が既にステアリングホイールを元に戻し始めており緩慢にステアリングホイールを戻すことが望まれる逸脱回避側よりも、車線端部に向かっており直ちにステアリングホイールを元に戻すことが望まれる逸脱側のほうが、大きい反力を得られるようになる。
This makes it possible to separately obtain the reaction force on the steering input increase side (departure side) and the reaction force on the steering return side (departure avoidance side). The reaction force control can be switched according to
In addition, even when the driving conditions of the vehicle are the same, the driver is already returning the steering wheel to the original position, and it is desired to slowly return the steering wheel. A larger reaction force can be obtained on the departure side where it is desired to immediately return the steering wheel to the original position.

(2)本実施形態に係る車線維持支援装置は、車両の走行状況としての車両が車線から逸脱するまでに要する時間を表す逸脱余裕時間に応じて第1処理と第2処理とを実施する。
これにより、逸脱余裕時間が短いほど操舵反力トルクが増大し、かつ、切り増し側(逸脱側)と切り戻し側(逸脱回避側)とで操舵反力トルクが異なるように制御することができる。
(3)本実施形態に係る車線維持支援装置は、車両の走行状況としての車両の車線における横位置に応じて第1処理と第2処理とを実施する。
これにより、横位置偏差が大きいほど操舵反力トルクが増大し、かつ、切り増し側(逸脱側)と切り戻し側(逸脱回避側)とで操舵反力トルクが異なるように制御することができる。
(2) The lane keeping assistance device according to the present embodiment performs the first process and the second process in accordance with the deviation margin time that represents the time required for the vehicle to depart from the lane as the traveling state of the vehicle.
As a result, the steering reaction force torque increases as the departure margin time decreases, and the steering reaction force torque can be controlled to be different between the increased side (departure side) and the return side (departure avoidance side). ..
(3) The lane keeping assist device according to the present embodiment performs the first process and the second process according to the lateral position of the vehicle in the lane as the traveling state of the vehicle.
As a result, the steering reaction force torque increases as the lateral position deviation increases, and the steering reaction force torque can be controlled to be different between the increased side (departure side) and the switched back side (departure avoidance side). ..

(4)本実施形態に係る車線維持支援装置は、操舵入力の方向の変化に応じて、第1処理により求められる操舵反力トルクと、第2処理により求められる操舵反力トルクとを切り替える。
これにより、操舵入力の方向に応じて、横位置に応じた操舵反力トルクを、車線の逸脱側と逸脱回避側との間で切り替えることができる。
(5)本実施形態に係る車線維持支援装置は、操舵入力の方向の変化があったときに操舵反力トルクの切り替えを遅らせる不感帯を有する。
これにより、操舵入力に対する反応を緩和し、急に方向が切り替わって挙動が不安定になるのを回避することができる。
(4) The lane keeping assist device according to the present embodiment switches between the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process according to the change in the direction of the steering input.
Thus, the steering reaction torque according to the lateral position can be switched between the departure side and the departure avoidance side of the lane depending on the direction of the steering input.
(5) The lane keeping assist device according to the present embodiment has a dead zone that delays the switching of the steering reaction force torque when there is a change in the steering input direction.
As a result, it is possible to mitigate the reaction to the steering input and prevent the behavior from becoming unstable due to the sudden change of direction.

(6)本実施形態に係る車線維持支援装置は、操舵入力の方向の変化に応じて操舵反力トルクを切り替える際に、切換前の操舵反力トルクの割合が徐々に減少し、切換後の操舵反力トルクの割合が徐々に増加するように、第1処理により求められる操舵反力トルクと第2処理により求められる操舵反力トルクとにそれぞれの割合を乗じて加算した値を、車両の走行状況に応じた操舵反力トルクとしてステアリングホイールに付与する。
これにより、逸脱側と逸脱回避側との間で、操舵反力トルクを円滑に切り替えながら制御することができる。
(6) In the lane keeping assist device according to the present embodiment, when switching the steering reaction torque according to the change in the direction of the steering input, the ratio of the steering reaction torque before the switching gradually decreases, and after the switching, The value obtained by multiplying the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process by the respective ratios and adding the values is added so that the ratio of the steering reaction force torque gradually increases. It is applied to the steering wheel as steering reaction torque according to the driving situation.
As a result, the steering reaction torque can be controlled while being smoothly switched between the departure side and the departure avoidance side.

(7)本実施形態に係る車線維持支援装置は、ステアリングホイールの操舵状態が逸脱方向に大きくなるに従って大きな値となる操舵状態値が、その時点で保持している操舵状態値であるラッチ値よりも大きくなれば、その時点の操舵状態値でラッチ値を更新する一方で、その時点の操舵状態値が、その時点のラッチ値以下であればラッチ値を保持し、操舵状態値がその時点のラッチ値から予め設定されたヒステリシス値の分だけ小さい値に変化するまでの間は、第1処理により求められる操舵反力トルクの割合は徐々に減少し、第2処理により求められる操舵反力トルクの割合は徐々に増加するように、第1処理により求められる操舵反力トルクと第2処理により求められる操舵反力トルクとにそれぞれの割合を乗じて加算した値を、車両の走行状況に応じた操舵反力トルクとしてステアリングホイールに付与する。
これにより、逸脱側から逸脱回避側への操舵反力トルクの急激な変化を回避し、緩やかに操舵反力トルクが切り替わるように制御することができる。
(7) In the lane keeping assist device according to the present embodiment, the steering state value that increases as the steering state of the steering wheel increases in the departure direction is larger than the latch value that is the steering state value held at that time. If it also becomes larger, the latch value is updated with the steering state value at that time, while if the steering state value at that time is less than or equal to the latch value at that time, the latch value is held, and the steering state value at that time is maintained. Until the latch value changes to a value smaller by a preset hysteresis value, the ratio of the steering reaction force torque obtained by the first process gradually decreases, and the steering reaction force torque obtained by the second process decreases. The value obtained by multiplying the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process by the respective ratios and adding them is added so as to increase gradually. The steering reaction torque is applied to the steering wheel.
As a result, it is possible to avoid a sudden change in the steering reaction force torque from the departure side to the departure avoidance side, and perform control so that the steering reaction force torque is gently switched.

(8)本実施形態に係る車線維持支援装置は、操舵状態値が、その時点のラッチ値からヒステリシス値の分だけ減じた値よりも小さくなった場合には、その時点の操舵状態値にヒステリシス値を加えた値でラッチ値を更新する。
これにより、逸脱側の操舵反力トルクと逸脱回避側の操舵反力トルクとのそれぞれの割合(切り替えゲイン)を1よりも大きくしないために、差分をヒステリシス値の分までとして、それぞれの割合を0〜1で変化させるようにすることができる。
(8) In the lane keeping assist device according to the present embodiment, when the steering state value becomes smaller than the value obtained by subtracting the hysteresis value from the latch value at that time, the steering state value at that time has hysteresis. Update the latch value with the added value.
As a result, the respective ratios (switching gains) of the steering reaction torque on the departure side and the steering reaction torque on the departure avoidance side are not made larger than 1, and the respective differences are set to the hysteresis value. It can be changed from 0 to 1.

(9)本実施形態に係る車線維持支援装置は、操舵反力トルクの値が0になった時点又は操舵反力トルクの符号が逆になった時点で、ラッチ値をその時点の操舵状態値で更新する初期化処理を行う。
これにより、ステアリングホイールに左方向への反力が発生している場合から、右方向への反力が発生している場合に切り替わった時に、ラッチ値を適切に更新することができる。
(9) The lane keeping assist device according to the present embodiment, when the value of the steering reaction force torque becomes 0 or when the sign of the steering reaction force torque is reversed, sets the latch value to the steering state value at that time. Perform initialization processing to update with.
As a result, the latch value can be appropriately updated when the steering wheel is switched from the case where the leftward reaction force is generated to the case where the rightward reaction force is generated.

(10)上記の操舵状態値は、ステアリングホイールの操舵角、ステアリングホイールに発生する操舵トルク、及び道路形状から推定される推定ヨーレートと実際に発生している実ヨーレートとの差分のうちのいずれかである。
すなわち、上記の操舵状態値として、操舵角、操舵トルク、及び推定ヨーレートと実ヨーレートとの差分のうちのいずれかを用いることができる。
なお、上記の操舵状態値として操舵角を用いる場合、上記のラッチ値はラッチ操舵角であり、上記のヒステリシス値は操舵角ヒスである。
(10) The steering state value is one of the steering angle of the steering wheel, the steering torque generated in the steering wheel, and the difference between the estimated yaw rate estimated from the road shape and the actually generated yaw rate. Is.
That is, any one of the steering angle, the steering torque, and the difference between the estimated yaw rate and the actual yaw rate can be used as the steering state value.
When the steering angle is used as the steering state value, the latch value is the latch steering angle, and the hysteresis value is the steering angle hiss.

また、操舵角と操舵トルクとは、いずれもステアリングホイールの回転の度合いを示す値であるため、互換性がある。例えば、操舵角はステアリングホイールの回転角を示し、操舵トルクはステアリングホイールの回転方向の力を示す。操舵トルクにより、車線中央からの逸脱の度合いを示す。
また、操舵角に相当する情報として、推定ヨーレートと実ヨーレートとの差分を用いることができる。例えば、推定ヨーレートは、車線に沿って道なりに走行していると仮定した場合のヨーレートであり、実ヨーレートは、実際のヨーレートである。推定ヨーレートと実ヨーレートとの差分により、車線中央からの逸脱の度合いを示す。
Further, since the steering angle and the steering torque are both values indicating the degree of rotation of the steering wheel, they are compatible with each other. For example, the steering angle indicates the rotation angle of the steering wheel, and the steering torque indicates the force in the rotation direction of the steering wheel. The steering torque indicates the degree of deviation from the center of the lane.
Further, the difference between the estimated yaw rate and the actual yaw rate can be used as the information corresponding to the steering angle. For example, the estimated yaw rate is the yaw rate when it is assumed that the vehicle is traveling along the lane along the road, and the actual yaw rate is the actual yaw rate. The difference between the estimated yaw rate and the actual yaw rate indicates the degree of deviation from the center of the lane.

(11)本実施形態に係る車線維持支援装置は、第1処理において操舵反力トルクを求めるために用いられる逸脱側マップと、第2処理において操舵反力トルクを求めるために用いられる逸脱回避側マップとを有する。
これにより、ステアバイワイヤシステムを用いた車両において、操舵入力の切り増し側(逸脱側)での反力を指示するマップと、切り戻し側(逸脱回避側)での反力を指示するマップとを用いて、操舵入力の切り増し又は切り戻しに応じて反力制御を切り替えることができる。
(11) The lane keeping assist system according to the present embodiment includes a departure side map used to obtain a steering reaction force torque in the first process and a departure avoidance side used to obtain a steering reaction force torque in the second process. With a map.
Thus, in a vehicle using the steer-by-wire system, a map indicating the reaction force on the steering input increasing side (departure side) and a map indicating the reaction force on the steering return side (departure avoidance side) are provided. By using this, the reaction force control can be switched according to the increase or the return of the steering input.

(変形例)
[逸脱余裕時間又は横位置のいずれか一方のみに応じた操舵反力トルクの算出]
上記の説明では、本実施形態に係る車線維持支援装置は、車両が車線から逸脱するまでに要する時間を表す逸脱余裕時間に応じた操舵反力トルクと、車両の車線における横位置に応じた操舵反力トルクとの両方を求めている。但し、実際には、いずれか一方の操舵反力トルクのみ求めるようにしても良い。この場合、図4に示す操舵反力トルクオフセット部24において、逸脱余裕時間に応じた反力演算部25と、横位置に応じた反力演算部26とのうちいずれか一方のみ設ければ良い。若しくは、図4に示す操舵反力トルクオフセット部24において、車両Aが低速の場合には逸脱余裕時間に応じた反力演算部25を利用し、車両Aが高速の場合には横位置に応じた反力演算部26を利用するようにしても良い。これにより、図4に示す操舵反力トルクオフセット部24において、反力選択部24cは不要となる。また、いずれか一方の操舵反力トルクのみ求めれば良いため、処理負荷が低減し、かつ、処理速度が向上する。
(Modification)
[Calculation of steering reaction torque according to either deviation time or lateral position]
In the above description, the lane keeping assist device according to the present embodiment is configured such that the steering reaction force torque according to the departure margin time that represents the time required for the vehicle to depart from the lane and the steering response according to the lateral position of the vehicle in the lane. It demands both reaction torque and torque. However, in actuality, only one of the steering reaction force torques may be obtained. In this case, in the steering reaction force torque offset unit 24 shown in FIG. 4, only one of the reaction force calculation unit 25 according to the deviation margin time and the reaction force calculation unit 26 according to the lateral position may be provided. .. Alternatively, in the steering reaction force torque offset unit 24 shown in FIG. 4, when the vehicle A is at a low speed, the reaction force calculation unit 25 according to the departure margin time is used, and when the vehicle A is at a high speed, the reaction force calculation unit 25 is used according to the lateral position. Alternatively, the reaction force calculation unit 26 may be used. This eliminates the need for the reaction force selection unit 24c in the steering reaction force torque offset unit 24 shown in FIG. Further, since only one of the steering reaction torques is required, the processing load is reduced and the processing speed is improved.

[マップの即時切り替え]
図13〜図16において、本実施形態に係る車線維持支援装置は、運転者がステアリングホイール1aを切るのを止めた時(図中のY点)、その時点で切り増しゲインを1から0に即時更新し、切り戻しゲインを0から1に即時更新することで(図11のステップS301、S302)、直ちに切り増し側(逸脱側)のマップから切り戻し側(逸脱回避側)のマップに遷移しても良い(図中のY点→Z点)。
[Switch map immediately]
13 to 16, when the driver stops turning the steering wheel 1a (point Y in the drawings), the lane keeping assist device according to the present embodiment changes the additional gain from 1 to 0 at that time. Immediately updating and immediately updating the switchback gain from 0 to 1 (steps S301 and S302 in FIG. 11) immediately shifts from the map on the surplus side (deviation side) to the map on the switchback side (deviation avoidance side). It may be done (point Y → point Z in the figure).

これにより、ステアリングホイール1aの回転方向の切り替え時における切り替えゲインの演算及び操舵反力トルクの算出が単純化するため、処理の高速化と負荷低減を図ることができる。例えば、スポーツカーのように、高速で走行することが多く、処理の高速化が求められ、かつ、操舵反力トルクを急に切り替えても運転者への影響が少ない(あまり違和感がない)と推測される車種の場合には、上記のように、直ちに切り増し側(逸脱側)のマップから切り戻し側(逸脱回避側)のマップに遷移する。 This simplifies the calculation of the switching gain and the calculation of the steering reaction force torque when switching the rotation direction of the steering wheel 1a, so that the processing speed can be increased and the load can be reduced. For example, like a sports car, it often travels at high speed, requires high-speed processing, and even if the steering reaction torque is suddenly switched, it has little effect on the driver (there is little discomfort). In the case of an estimated vehicle type, as described above, the map on the additional side (departure side) is immediately changed to the map on the reverting side (departure avoidance side).

[運転者の意図的な車線逸脱への対応]
上記の説明では、本実施形態に係る車線維持支援装置は、車両Aが車線端部(道路白線)に寄っている場合に車両Aを車線中央に戻すように車線維持制御する。但し、実際には、(I)走行車線から隣接車線に車線変更する場合、(II)本線車線から分流車線に移動する場合、(III)合流車線から本線車線に移動する場合、若しくは(IV)緊急時に路側帯に停車する場合、又は(V)道路沿いの店舗や駐車場等に進入する場合等のように、運転者が車線端部の外側への移動を所望する場合には、本実施形態に係る車線維持制御を中断するようにしても良い。
[Response to intentional lane departure of driver]
In the above description, the lane keeping assist device according to the present embodiment performs lane keeping control so as to return the vehicle A to the center of the lane when the vehicle A is close to the lane end (white line of the road). However, in reality, (I) changing lanes from driving lanes to adjacent lanes, (II) moving from main lanes to branch lanes, (III) moving from merged lanes to main lanes, or (IV) If the driver wants to move to the outside of the lane edge, such as when stopping in the roadside belt in an emergency or when entering a store or parking lot along the (V) road, this implementation The lane keeping control according to the embodiment may be interrupted.

具体的には、取得した道路情報や白線情報等において車線端部の外側に車両Aが進入可能な領域(他の車線、ジャンクション、サービスエリア、路側帯、店舗、公共施設、駐車場等)があるときに、(I)方向指示器を作動させている場合、(II)運転者が一定の角度(閾値)以上に切り増し側(逸脱側)にステアリングホイール1aを切っている場合、又は(III)車両Aを車線中央に戻す操舵反力トルクを発生させても運転者が切り増し側(逸脱側)にステアリングホイール1aを切り続けている場合には、運転者が車線端部の外側への移動を所望していると判断して、本実施形態に係る車線維持制御を中断する。例えば、指令操舵反力トルクや指令転舵角を電流ドライバに出力しない。 Specifically, in the acquired road information, white line information, etc., the area where the vehicle A can enter outside the lane end (other lanes, junctions, service areas, roadsides, shops, public facilities, parking lots, etc.) At a certain time, (I) when operating the turn signal indicator, (II) when the driver turns the steering wheel 1a to the side (departure side) that increases by more than a certain angle (threshold value), or ( III) If the driver continues to turn the steering wheel 1a to the additional side (departure side) even if the steering reaction torque that returns the vehicle A to the center of the lane is generated, the driver moves to the outside of the lane end. Lane maintenance control according to the present embodiment is interrupted. For example, the command steering reaction force torque and the command steering angle are not output to the current driver.

反対に、取得した道路情報や白線情報等において車線端部の外側に車両Aが進入可能な領域がない場合には、運転者が車線端部の外側への移動を所望していても、車線端部の外側への移動は不可能であると判断して、本実施形態に係る車線維持制御を無条件で実施する。
以上、本発明の実施形態を詳述してきたが、実際には、上記の実施形態に限られるものではなく、本発明の要旨を逸脱しない範囲の変更があっても本発明に含まれる。
On the contrary, if there is no area where the vehicle A can enter outside the lane end in the acquired road information, white line information, etc., even if the driver wants to move to the outside of the lane end, The lane keeping control according to the present embodiment is performed unconditionally, judging that it is impossible to move the end portion to the outside.
Although the embodiments of the present invention have been described above in detail, the present invention is not limited to the above-described embodiments in practice, and modifications within the scope of the present invention are included in the present invention.

1 操舵部
1a ステアリングホイール
1b コラムシャフト
1c 反力モータ
1d 操舵角センサ
1e トルクセンサ
2 転舵部
2a ピニオンシャフト
2b ステアリングギア
2c 転舵モータ
2d 転舵角センサ
2e ラックギア
2f ラック
3 バックアップクラッチ
4 SBWコントローラ
4a 映像処理部
5FL、5FR 左右前輪
6 カメラ
7 各種センサ
7a 車速センサ
7b 加速度センサ
7c ペダル操作センサ
8 ナビゲーションシステム
9 電流ドライバ
9a 反力モータ用電流ドライバ
9b 転舵モータ用電流ドライバ
10 車線維持制御部
10a 補正操舵角設定部
10b ラッチ操舵角更新部
10c 切り替えゲイン演算部
20 操舵反力制御部
21 横力演算部
22 横力オフセット部
23 SAT演算部
24 操舵反力トルクオフセット部
25 逸脱余裕時間に応じた反力演算部
25e 逸脱余裕時間反力マップ演算部
26 横位置に応じた反力演算部
26d 横位置偏差反力マップ演算部
30 転舵制御部
31 SBW指令転舵角演算部
32 外乱抑制指令転舵角演算部
33 ヨー角に応じた反発力演算部
34 横位置に応じた反発力演算部
1 Steering unit 1a Steering wheel 1b Column shaft 1c Reaction force motor 1d Steering angle sensor 1e Torque sensor 2 Steering unit 2a Pinion shaft 2b Steering gear 2c Steering motor 2d Steering angle sensor 2e Rack gear 2f Rack 3 Backup clutch 4 SBW controller 4a Image processing unit 5FL, 5FR Left and right front wheels 6 Cameras 7 Various sensors 7a Vehicle speed sensor 7b Acceleration sensor 7c Pedal operation sensor 8 Navigation system 9 Current driver 9a Reaction force motor current driver 9b Steering motor current driver 10 Lane keeping control unit 10a Correction Steering angle setting unit 10b Latch steering angle updating unit 10c Switching gain calculation unit 20 Steering reaction force control unit 21 Lateral force calculation unit 22 Lateral force offset unit 23 SAT calculation unit 24 Steering reaction force torque offset unit 25 Reaction according to deviation allowance time Force calculation unit 25e Departure margin time reaction force map calculation unit 26 Reaction force calculation unit according to lateral position 26d Lateral position deviation reaction force map calculation unit 30 Steering control unit 31 SBW command steering angle calculation unit 32 Disturbance suppression command steering Angle calculation unit 33 Repulsion force calculation unit according to yaw angle 34 Repulsion force calculation unit according to lateral position

Claims (14)

運転者の操舵入力を受けるステアリングホイールと、
前記ステアリングホイールと機械的に切り離された転舵輪と、
車両が車線から逸脱するまでに要する時間を表す逸脱余裕時間に応じた操舵反力トルクを求めて前記ステアリングホイールに付与する操舵反力制御部と、
を備え、
前記操舵反力制御部は、前記逸脱余裕時間に応じた操舵反力トルクを求める処理として、前記操舵入力が、前記車両が前記車線から逸脱する側への操舵入力である場合の前記操舵反力トルクを求める第1処理と、前記操舵入力が、前記車両が前記車線からの逸脱を回避する側への操舵入力である場合の前記操舵反力トルクを求める第2処理と、を別々に実施可能となっており、
前記逸脱余裕時間が同一のとき、前記第1処理により求められる前記操舵反力トルクのほうが、前記第2処理により求められる前記操舵反力トルクよりも大きいことを特徴とする車線維持支援装置。
A steering wheel that receives the steering input of the driver,
Steered wheels mechanically separated from the steering wheel;
A steering reaction force control unit that determines a steering reaction force torque according to a deviation margin time that represents a time required for the vehicle to deviate from the lane and applies the steering reaction force torque to the steering wheel,
Equipped with
The steering reaction force control unit performs the steering reaction force when the steering input is a steering input to a side where the vehicle deviates from the lane, as processing for obtaining a steering reaction force torque according to the departure margin time. A first process for obtaining the torque and a second process for obtaining the steering reaction torque when the steering input is a steering input to the side that avoids the vehicle from departing from the lane can be separately performed. Has become
The lane keeping assist device, wherein the steering reaction force torque obtained by the first process is larger than the steering reaction force torque obtained by the second process when the departure margin times are the same.
運転者の操舵入力を受けるステアリングホイールと、
前記ステアリングホイールと機械的に切り離された転舵輪と、
車両の車線における横位置に応じた操舵反力トルクを求めて前記ステアリングホイールに付与する操舵反力制御部と、
を備え、
前記操舵反力制御部は、前記横位置に応じた操舵反力トルクを求める処理として、前記車両が車線の逸脱方向に近づく際に前記操舵反力トルクを求める第1処理と、前記車両が車線の逸脱回避方向に近づく際に前記操舵反力トルクを求める第2処理と、を別々に実施可能となっており、
前記横位置が同一のとき、前記第1処理により求められる前記操舵反力トルクのほうが、前記第2処理により求められる前記操舵反力トルクよりも大きく、
前記操舵反力制御部は、前記操舵入力の回転方向の変化に応じて、前記第1処理により求められる前記操舵反力トルクと、前記第2処理により求められる前記操舵反力トルクとを切り替え、
前記操舵反力制御部は、前記操舵入力の回転方向の変化に応じて前記操舵反力トルクを切り替える際に、切換前の前記操舵反力トルクの割合が徐々に減少し、切換後の前記操舵反力トルクの割合が徐々に増加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与し、
前記操舵反力制御部は、前記ステアリングホイールの操舵状態が逸脱方向に大きくなるに従って大きな値となる操舵状態値が、その時点で保持している前記操舵状態値であるラッチ値よりも大きくなれば、その時点の前記操舵状態値でラッチ値を更新する一方で、その時点の前記操舵状態値が、その時点の前記ラッチ値以下であれば前記ラッチ値を保持し、前記操舵状態値がその時点の前記ラッチ値から予め設定された固定値の分だけ小さい値に変化するまでの間は、前記第1処理により求められる前記操舵反力トルクの割合は徐々に減少し、前記第2処理により求められる前記操舵反力トルクの割合は徐々に増加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの前記割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与する、
ことを特徴とする車線維持支援装置。
A steering wheel that receives the steering input of the driver,
Steered wheels mechanically separated from the steering wheel;
A steering reaction force control unit that obtains a steering reaction force torque according to a lateral position in the lane of the vehicle and applies the steering reaction force torque to the steering wheel,
Equipped with
The steering reaction force control unit includes a first process for obtaining the steering reaction force torque when the vehicle approaches a lane departure direction, and a process for obtaining the steering reaction force torque according to the lateral position; It is possible to separately carry out the second processing for obtaining the steering reaction torque when approaching the deviation avoidance direction of
When the lateral positions are the same, the steering reaction force torque obtained by the first process is larger than the steering reaction force torque obtained by the second process,
The steering reaction force control unit switches between the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process in accordance with a change in the rotation direction of the steering input.
When switching the steering reaction torque according to the change in the rotation direction of the steering input, the steering reaction force control unit gradually reduces the ratio of the steering reaction torque before switching, and the steering after switching. A value obtained by multiplying the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process by the respective ratios and adding the values so that the ratio of the reaction torque gradually increases Imparting to the steering wheel as the steering reaction torque according to the traveling state of the vehicle,
The steering reaction force control unit, when the steering state value which becomes larger as the steering state of the steering wheel becomes larger in the departure direction becomes larger than the latch value which is the steering state value held at that time point. , The latch value is updated with the steering state value at that time, while the steering state value at that time is less than or equal to the latch value at that time, the latch value is held, and the steering state value is at that time. The ratio of the steering reaction force torque obtained by the first process gradually decreases until the latch value changes from the latch value to a value that is smaller by a preset fixed value, and is obtained by the second process. The steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process are multiplied by the respective ratios so that the ratio of the steering reaction force torque gradually increases. The added value is given to the steering wheel as the steering reaction torque according to the traveling state of the vehicle,
A lane keeping assist device characterized in that
前記操舵反力制御部は、前記操舵入力の回転方向の変化に応じて、前記第1処理により求められる前記操舵反力トルクと、前記第2処理により求められる前記操舵反力トルクとを切り替える請求項1に記載の車線維持支援装置。 The steering reaction force control unit switches between the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process in accordance with a change in the rotation direction of the steering input. The lane keeping assist device according to Item 1. 前記操舵反力制御部は、前記操舵入力の回転方向の変化があったときに前記操舵反力トルクの切り替えを遅らせる不感帯を有する請求項2又は請求項3に記載の車線維持支援装置。 The lane keeping assist device according to claim 2 or 3, wherein the steering reaction force control unit has a dead zone that delays switching of the steering reaction force torque when the rotation direction of the steering input changes. 前記操舵反力制御部は、前記操舵入力の回転方向の変化に応じて前記操舵反力トルクを切り替える際に、切換前の前記操舵反力トルクの割合が徐々に減少し、切換後の前記操舵反力トルクの割合が徐々に増加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与する請求項3に記載の車線維持支援装置。 When switching the steering reaction torque according to the change in the rotation direction of the steering input, the steering reaction force control unit gradually reduces the ratio of the steering reaction torque before switching, and the steering after switching. A value obtained by multiplying the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process by the respective ratios and adding the values so that the ratio of the reaction torque gradually increases The lane keeping assist device according to claim 3, wherein the steering reaction force torque is applied to the steering wheel according to a traveling state of the vehicle. 前記操舵反力制御部は、前記ステアリングホイールの操舵状態が逸脱方向に大きくなるに従って大きな値となる操舵状態値が、その時点で保持している前記操舵状態値であるラッチ値よりも大きくなれば、その時点の前記操舵状態値でラッチ値を更新する一方で、その時点の前記操舵状態値が、その時点の前記ラッチ値以下であれば前記ラッチ値を保持し、前記操舵状態値がその時点の前記ラッチ値から予め設定された固定値の分だけ小さい値に変化するまでの間は、前記第1処理により求められる前記操舵反力トルクの割合は徐々に減少し、前記第2処理により求められる前記操舵反力トルクの割合は徐々に増加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの前記割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与する請求項5に記載の車線維持支援装置。 The steering reaction force control unit, when the steering state value which becomes larger as the steering state of the steering wheel becomes larger in the departure direction becomes larger than the latch value which is the steering state value held at that time point. , The latch value is updated with the steering state value at that time, while the steering state value at that time is less than or equal to the latch value at that time, the latch value is held, and the steering state value is at that time. The ratio of the steering reaction force torque obtained by the first process gradually decreases until the latch value changes from the latch value to a value that is smaller by a preset fixed value, and is obtained by the second process. The steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process are multiplied by the respective ratios so that the ratio of the steering reaction force torque gradually increases. The lane keeping assist device according to claim 5, wherein the added value is applied to the steering wheel as the steering reaction force torque according to the traveling state of the vehicle. 運転者の操舵入力を受けるステアリングホイールと、
前記ステアリングホイールと機械的に切り離された転舵輪と、
車両が車線から逸脱するまでに要する時間を表す逸脱余裕時間又は前記車両の前記車線における横位置である前記車両の走行状況に応じた操舵反力トルクを求めて前記ステアリングホイールに付与する操舵反力制御部と、
を備え、
前記操舵反力制御部は、前記車両の走行状況に応じた操舵反力トルクを求める処理として、前記操舵入力が、前記車両が前記車線から逸脱する側への操舵入力である場合の前記操舵反力トルクを求める第1処理と、前記操舵入力が、前記車両が前記車線からの逸脱を回避する側への操舵入力である場合の前記操舵反力トルクを求める第2処理と、を別々に実施可能となっており、
前記車両の走行状況が同一のとき、前記第1処理により求められる前記操舵反力トルクのほうが、前記第2処理により求められる前記操舵反力トルクよりも大きく、
前記操舵反力制御部は、前記操舵入力の回転方向の変化に応じて、前記第1処理により求められる前記操舵反力トルクと、前記第2処理により求められる前記操舵反力トルクとを切り替え、
前記操舵反力制御部は、前記操舵入力の回転方向の変化に応じて前記操舵反力トルクを切り替える際に、切換前の前記操舵反力トルクの割合が徐々に減少し、切換後の前記操舵反力トルクの割合が徐々に増加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与し、
前記操舵反力制御部は、前記ステアリングホイールの操舵状態が逸脱方向に大きくなるに従って大きな値となる操舵状態値が、その時点で保持している前記操舵状態値であるラッチ値よりも大きくなれば、その時点の前記操舵状態値でラッチ値を更新する一方で、その時点の前記操舵状態値が、その時点の前記ラッチ値以下であれば前記ラッチ値を保持し、前記操舵状態値がその時点の前記ラッチ値から予め設定された固定値の分だけ小さい値に変化するまでの間は、前記第1処理により求められる前記操舵反力トルクの割合は徐々に減少し、前記第2処理により求められる前記操舵反力トルクの割合は徐々に増加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの前記割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与することを特徴とする車線維持支援装置。
A steering wheel that receives the steering input of the driver,
Steered wheels mechanically separated from the steering wheel;
Steering reaction force applied to the steering wheel by obtaining a deviation margin time representing the time required for the vehicle to deviate from the lane or a steering reaction force torque corresponding to the traveling state of the vehicle, which is the lateral position of the vehicle in the lane. A control unit,
Equipped with
The steering reaction force control unit, as a process of obtaining a steering reaction force torque according to a traveling state of the vehicle, is the steering reaction force when the steering input is a steering input to a side where the vehicle deviates from the lane. The first process for obtaining the force torque and the second process for obtaining the steering reaction force torque when the steering input is the steering input to the side that avoids the vehicle from departing from the lane are separately performed. Is possible,
When the traveling conditions of the vehicle are the same, the steering reaction force torque obtained by the first process is larger than the steering reaction force torque obtained by the second process,
The steering reaction force control unit switches between the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process in accordance with a change in the rotation direction of the steering input.
When switching the steering reaction torque according to the change in the rotation direction of the steering input, the steering reaction force control unit gradually reduces the ratio of the steering reaction torque before switching, and the steering after switching. A value obtained by multiplying the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process by the respective ratios and adding the values so that the ratio of the reaction torque gradually increases Imparting to the steering wheel as the steering reaction torque according to the traveling state of the vehicle,
The steering reaction force control unit, when the steering state value which becomes larger as the steering state of the steering wheel becomes larger in the departure direction becomes larger than the latch value which is the steering state value held at that time point. , The latch value is updated with the steering state value at that time, while the steering state value at that time is less than or equal to the latch value at that time, the latch value is held, and the steering state value is at that time. The ratio of the steering reaction force torque obtained by the first process gradually decreases until the latch value changes from the latch value to a value that is smaller by a preset fixed value, and is obtained by the second process. The steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process are multiplied by the respective ratios so that the ratio of the steering reaction force torque gradually increases. A lane keeping assist device, wherein the added value is applied to the steering wheel as the steering reaction torque according to the traveling condition of the vehicle.
前記操舵反力制御部は、前記操舵状態値が、その時点の前記ラッチ値から前記固定値の分だけ減じた値よりも小さくなった場合には、その時点の前記操舵状態値に前記固定値を加えた値で前記ラッチ値を更新する請求項2、6及び7のいずれか一項に記載の車線維持支援装置。 The steering reaction force control unit, the steering state value, if it becomes smaller than the amount obtained by subtracting the value of the fixed value from the latch value of that time, the fixed value to the steering state value at that time The lane keeping assist device according to any one of claims 2, 6 and 7, which updates the latch value with a value added with. 前記操舵反力制御部は、前記操舵反力トルクの値が0になった時点又は前記操舵反力トルクの符号が逆になった時点で、前記ラッチ値をその時点の前記操舵状態値で更新する初期化処理を行う請求項2及び6〜8のいずれか一項に記載の車線維持支援装置。 The steering reaction force control unit updates the latch value with the steering state value at that point in time when the value of the steering reaction force torque becomes 0 or when the sign of the steering reaction force torque is reversed. The lane keeping assist device according to claim 2, wherein the initialization process is performed. 前記操舵状態値は、前記ステアリングホイールの操舵角、前記ステアリングホイールに発生する操舵トルク、及び道路形状から推定される推定ヨーレートと実際に発生している実ヨーレートとの差分のうちのいずれかである請求項2及び6〜9のいずれか一項に記載の車線維持支援装置。 The steering state value is one of a steering angle of the steering wheel, a steering torque generated in the steering wheel, and a difference between an estimated yaw rate estimated from a road shape and an actually generated yaw rate. The lane keeping assist device according to any one of claims 2 and 6 to 9. 前記操舵反力制御部は、前記第1処理において前記操舵反力トルクを求めるために用いられる逸脱側マップと、前記第2処理において前記操舵反力トルクを求めるために用いられる逸脱回避側マップとを有する請求項1から請求項10のいずれか一項に記載の車線維持支援装置。 The steering reaction force control unit includes a departure side map used to obtain the steering reaction force torque in the first process, and a departure avoidance side map used to obtain the steering reaction force torque in the second process. The lane keeping assist device according to any one of claims 1 to 10, further comprising: 運転者の操舵入力を受けるステアリングホイールに、車両が車線から逸脱するまでに要する時間を表す逸脱余裕時間に応じた操舵反力トルクを付与することで、前記車両の車線維持制御を行う車線維持支援方法において、
前記操舵入力が、前記車両が前記車線から逸脱する側への操舵入力である場合の前記操舵反力トルクを求める第1処理と、前記操舵入力が、前記車両が前記車線からの逸脱を回避する側への操舵入力である場合の前記操舵反力トルクを求める第2処理と、を別々に実施し、
前記逸脱余裕時間が同一のとき、前記第1処理により求められる前記操舵反力トルクのほうが、前記第2処理により求められる前記操舵反力トルクよりも大きいことを特徴とする車線維持支援方法。
A lane keeping assist for performing lane keeping control of the vehicle by applying a steering reaction force torque to a steering wheel that receives a steering input of a driver in accordance with a departure margin time that represents a time required for the vehicle to depart from the lane. In the method
A first process of obtaining the steering reaction torque when the steering input is a steering input to a side where the vehicle deviates from the lane, and the steering input prevents the vehicle from deviating from the lane. And a second process for obtaining the steering reaction force torque when the steering input is to the side,
The lane keeping assist method, wherein the steering reaction force torque obtained by the first process is larger than the steering reaction force torque obtained by the second process when the departure margin times are the same.
運転者の操舵入力を受けるステアリングホイールに、車両の車線における横位置に応じた操舵反力トルクを付与することで、前記車両の車線維持制御を行う車線維持支援方法において、
前記操舵入力が、前記車両が前記車線から逸脱する側への操舵入力である場合の前記操舵反力トルクを求める第1処理と、前記操舵入力が、前記車両が前記車線からの逸脱を回避する側への操舵入力である場合の前記操舵反力トルクを求める第2処理と、を別々に実施し、
前記横位置が同一のとき、前記第1処理により求められる前記操舵反力トルクのほうが、前記第2処理により求められる前記操舵反力トルクよりも大きく、
前記操舵入力の回転方向の変化に応じて、前記第1処理により求められる前記操舵反力トルクと、前記第2処理により求められる前記操舵反力トルクとを切り替え、
前記操舵入力の回転方向の変化に応じて前記操舵反力トルクを切り替える際に、切換前の前記操舵反力トルクの割合が徐々に減少し、切換後の前記操舵反力トルクの割合が徐々に増加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与し、
前記ステアリングホイールの操舵状態が逸脱方向に大きくなるに従って大きな値となる操舵状態値が、その時点で保持している前記操舵状態値であるラッチ値よりも大きくなれば、その時点の前記操舵状態値でラッチ値を更新する一方で、その時点の前記操舵状態値が、その時点の前記ラッチ値以下であれば前記ラッチ値を保持し、前記操舵状態値がその時点の前記ラッチ値から予め設定された固定値の分だけ小さい値に変化するまでの間は、前記第1処理により求められる前記操舵反力トルクの割合は徐々に減少し、前記第2処理により求められる前記操舵反力トルクの割合は徐々に増加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの前記割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与する、ことを特徴とする車線維持支援方法。
A lane keeping assist method for performing lane keeping control of the vehicle by applying a steering reaction torque according to a lateral position in a lane of a vehicle to a steering wheel that receives a steering input from a driver,
A first process of obtaining the steering reaction torque when the steering input is a steering input to a side where the vehicle deviates from the lane, and the steering input prevents the vehicle from deviating from the lane. And a second process for obtaining the steering reaction force torque when the steering input is to the side,
When the lateral positions are the same, the steering reaction force torque obtained by the first process is larger than the steering reaction force torque obtained by the second process,
Switching between the steering reaction torque obtained by the first processing and the steering reaction torque obtained by the second processing according to a change in the rotation direction of the steering input,
When switching the steering reaction torque according to the change in the rotation direction of the steering input, the ratio of the steering reaction torque before switching gradually decreases, and the ratio of the steering reaction torque after switching gradually increases. A value obtained by multiplying the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process by the respective ratios and adding them is added so as to increase depending on the traveling state of the vehicle. Applied to the steering wheel as the steering reaction torque,
If the steering state value that increases as the steering state of the steering wheel increases in the departure direction becomes larger than the latch value that is the steering state value that is currently held, the steering state value at that time point While the latch value is updated with, the steering state value at that time is less than or equal to the latch value at that time, the latch value is held, and the steering state value is preset from the latch value at that time. The ratio of the steering reaction torque obtained by the first process gradually decreases until it changes to a value smaller by the fixed value, and the ratio of the steering reaction torque obtained by the second process decreases. So as to gradually increase, a value obtained by multiplying the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process by the respective ratios and adding them is added. A lane keeping assist method, wherein the steering reaction torque according to a traveling situation is applied to the steering wheel.
運転者の操舵入力を受けるステアリングホイールに、車両が車線から逸脱するまでに要する時間を表す逸脱余裕時間又は前記車両の前記車線における横位置である前記車両の走行状況に応じた操舵反力トルクを付与することで、前記車両の車線維持制御を行う車線維持支援方法において、
前記操舵入力が、前記車両が前記車線から逸脱する側への操舵入力である場合の前記操舵反力トルクを求める第1処理と、前記操舵入力が、前記車両が前記車線からの逸脱を回避する側への操舵入力である場合の前記操舵反力トルクを求める第2処理と、を別々に実施し、
前記車両の走行状況が同一のとき、前記第1処理により求められる前記操舵反力トルクのほうが、前記第2処理により求められる前記操舵反力トルクよりも大きく、
前記操舵入力の回転方向の変化に応じて、前記第1処理により求められる前記操舵反力トルクと、前記第2処理により求められる前記操舵反力トルクとを切り替え、
前記操舵入力の回転方向の変化に応じて前記操舵反力トルクを切り替える際に、切換前の前記操舵反力トルクの割合が徐々に減少し、切換後の前記操舵反力トルクの割合が徐々に増
加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与し、
前記ステアリングホイールの操舵状態が逸脱方向に大きくなるに従って大きな値となる操舵状態値が、その時点で保持している前記操舵状態値であるラッチ値よりも大きくなれば、その時点の前記操舵状態値でラッチ値を更新する一方で、その時点の前記操舵状態値が、その時点の前記ラッチ値以下であれば前記ラッチ値を保持し、前記操舵状態値がその時点の前記ラッチ値から予め設定された固定値の分だけ小さい値に変化するまでの間は、前記第1処理により求められる前記操舵反力トルクの割合は徐々に減少し、前記第2処理により求められる前記操舵反力トルクの割合は徐々に増加するように、前記第1処理により求められる前記操舵反力トルクと前記第2処理により求められる前記操舵反力トルクとにそれぞれの前記割合を乗じて加算した値を、前記車両の走行状況に応じた前記操舵反力トルクとして前記ステアリングホイールに付与することを特徴とする車線維持支援方法。
A steering wheel that receives a steering input from the driver is provided with a deviation time representing the time required for the vehicle to deviate from the lane, or a steering reaction torque according to the running condition of the vehicle, which is the lateral position of the vehicle in the lane. By giving, in the lane keeping support method for performing lane keeping control of the vehicle,
A first process of obtaining the steering reaction torque when the steering input is a steering input to a side where the vehicle deviates from the lane, and the steering input prevents the vehicle from deviating from the lane. And a second process for obtaining the steering reaction force torque when the steering input is to the side,
When the traveling conditions of the vehicle are the same, the steering reaction force torque obtained by the first process is larger than the steering reaction force torque obtained by the second process,
Switching between the steering reaction torque obtained by the first processing and the steering reaction torque obtained by the second processing according to a change in the rotation direction of the steering input,
When switching the steering reaction torque according to the change in the rotation direction of the steering input, the ratio of the steering reaction torque before switching gradually decreases, and the ratio of the steering reaction torque after switching gradually increases. A value obtained by multiplying the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process by the respective ratios and adding them is added so as to increase depending on the traveling state of the vehicle. Applied to the steering wheel as the steering reaction torque,
If the steering state value that increases as the steering state of the steering wheel increases in the departure direction becomes larger than the latch value that is the steering state value that is currently held, the steering state value at that time point While the latch value is updated with, the steering state value at that time is less than or equal to the latch value at that time, the latch value is held, and the steering state value is preset from the latch value at that time. The ratio of the steering reaction torque obtained by the first process gradually decreases until it changes to a value smaller by the fixed value, and the ratio of the steering reaction torque obtained by the second process decreases. So as to gradually increase, a value obtained by multiplying the steering reaction force torque obtained by the first process and the steering reaction force torque obtained by the second process by the respective ratios and adding them is added. A lane keeping assist method, wherein the steering reaction force torque is applied to the steering wheel according to a traveling situation.
JP2014245842A 2014-12-04 2014-12-04 Lane maintenance support device and lane maintenance support method Active JP6745087B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2014245842A JP6745087B2 (en) 2014-12-04 2014-12-04 Lane maintenance support device and lane maintenance support method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2014245842A JP6745087B2 (en) 2014-12-04 2014-12-04 Lane maintenance support device and lane maintenance support method

Publications (2)

Publication Number Publication Date
JP2016107750A JP2016107750A (en) 2016-06-20
JP6745087B2 true JP6745087B2 (en) 2020-08-26

Family

ID=56122839

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2014245842A Active JP6745087B2 (en) 2014-12-04 2014-12-04 Lane maintenance support device and lane maintenance support method

Country Status (1)

Country Link
JP (1) JP6745087B2 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6662227B2 (en) * 2016-07-19 2020-03-11 株式会社デンソー Control device
WO2023079765A1 (en) * 2021-11-08 2023-05-11 株式会社ジェイテクト Motor control device

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3983324B2 (en) * 1997-01-09 2007-09-26 富士重工業株式会社 Vehicle lane departure prevention device
JP5971128B2 (en) * 2012-09-26 2016-08-17 日産自動車株式会社 Steering control device

Also Published As

Publication number Publication date
JP2016107750A (en) 2016-06-20

Similar Documents

Publication Publication Date Title
JP6583403B2 (en) Lane maintenance support device
RU2627262C2 (en) Control device for steering
RU2636636C2 (en) Stability control device
JP5794393B2 (en) Steering control device
JP5794394B2 (en) Steering control device
JP5994861B2 (en) Steering control device
JP7004076B2 (en) Steering control method and steering control device
JP5994860B2 (en) Steering control device
JP5979238B2 (en) Steering control device
WO2014050566A1 (en) Steering control device
JP5971126B2 (en) Steering control device
WO2018189912A1 (en) Vehicle control method and vehicle control device
JP6662187B2 (en) Driving support method and driving support device
JP2002046640A (en) Steering support device of vehicle
JP6662188B2 (en) Driving support method and driving support device
JP6745087B2 (en) Lane maintenance support device and lane maintenance support method
JP2015009644A (en) Steering control device
JP2015009761A (en) Steering control device
JP6206110B2 (en) Driving assistance device
JP6662189B2 (en) Driving support method and driving support device
JP2005162153A (en) Steering controller
JP6221416B2 (en) Steering control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20171030

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20180710

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20180724

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180919

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20190212

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190419

A911 Transfer of reconsideration by examiner before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20190507

A912 Removal of reconsideration by examiner before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A912

Effective date: 20190607

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200423

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200803

R150 Certificate of patent or registration of utility model

Ref document number: 6745087

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150