JP2013056576A - Steering assist device and method for vehicle - Google Patents
Steering assist device and method for vehicle Download PDFInfo
- Publication number
- JP2013056576A JP2013056576A JP2011194855A JP2011194855A JP2013056576A JP 2013056576 A JP2013056576 A JP 2013056576A JP 2011194855 A JP2011194855 A JP 2011194855A JP 2011194855 A JP2011194855 A JP 2011194855A JP 2013056576 A JP2013056576 A JP 2013056576A
- Authority
- JP
- Japan
- Prior art keywords
- steering
- target
- angle
- host vehicle
- current
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Abstract
Description
本発明は、操舵操作の支援となる情報を、操舵輪を介して運転者に提供する、車両の操舵支援装置及び操舵支援方法に関する。 The present invention relates to a vehicle steering assistance device and a steering assistance method for providing information to assist a steering operation to a driver via a steering wheel.
従来から、自車両に最適な走行経路を走行させることを目的として、運転者に、操舵輪（ステアリングホイール）を介して、操舵操作の支援となる情報を提供する操舵支援装置がある。このような操舵支援装置としては、例えば、特許文献１に記載されているものがある。
特許文献１に記載されている操舵支援装置は、現在及び将来的に予測される障害物へ接触する可能性を、障害物と自車両との間の相対運動に応じて設定することにより、障害物の回避に最適な走行経路を自車両が走行するための技術である。ここで、障害物の回避に最適な走行経路を自車両が走行するためには、操舵輪にトルクを出力する操舵制御を行う。
2. Description of the Related Art Conventionally, there is a steering assist device that provides information to assist a steering operation to a driver via a steering wheel (steering wheel) for the purpose of traveling an optimal travel route for the host vehicle. An example of such a steering assist device is described in Patent Document 1.
The steering assist device described in Patent Literature 1 sets the possibility of contact with an obstacle predicted at present and in the future according to the relative motion between the obstacle and the host vehicle. This is a technique for the host vehicle to travel on the optimal travel route for avoiding objects. Here, in order for the host vehicle to travel on the travel route optimal for avoiding the obstacle, steering control is performed to output torque to the steered wheels.
しかしながら、特許文献１に記載の操舵支援装置では、例えば、狭路における走行時等、頻繁な操舵操作を行う可能性がある状況下において、操舵輪に出力する操舵支援トルクが急激に変化する可能性や断続的に変化する可能性がある。
本発明は、上記のような問題点に着目してなされたもので、操舵支援トルクの急激な変化や断続的な変化を抑制することが可能な、車両の操舵支援装置及び操舵支援方法を提供することを課題とする。
However, in the steering assist device described in Patent Document 1, the steering assist torque output to the steerable wheels can change suddenly under circumstances where there is a possibility of frequent steering operations, for example, when traveling on narrow roads. May change intermittently or intermittently.
The present invention has been made paying attention to the above-described problems, and provides a vehicle steering assistance device and a steering assistance method capable of suppressing a rapid change and an intermittent change in steering assistance torque. The task is to do.
上記課題を解決するために、本発明の一態様は、誘導経路を自車両が走行するために操舵輪の目標とする回転角度である目標操舵角を算出し、目標操舵角と操舵輪の現在の回転角度との差分である操舵角偏差を算出する。そして、操舵角偏差を縮小させるための操舵支援トルクを算出し、この算出した操舵支援トルクを操舵輪へ出力する。ここで、上記の誘導経路は、自車両の走行路において自車両が走行すべき経路であり、誘導姿勢角、誘導横位置、自車両の現在の姿勢角、横位置及びヨーレートに基づいて生成する。また、誘導姿勢角は、自車両が走行する走行路において自車両が通過する目標位置である目標通過位置へ到達するまでに、自車両が目標とする姿勢角であり、誘導横位置は、目標通過位置へ到達するまでに、自車両が目標とする横位置である。 In order to solve the above problems, according to one aspect of the present invention, a target steering angle, which is a target rotation angle of a steering wheel in order for the vehicle to travel on a guidance route, is calculated. The steering angle deviation, which is the difference from the rotation angle, is calculated. Then, a steering assist torque for reducing the steering angle deviation is calculated, and the calculated steering assist torque is output to the steered wheels. Here, the guidance route is a route on which the host vehicle should travel on the traveling route of the host vehicle, and is generated based on the guide attitude angle, the guide lateral position, the current attitude angle of the host vehicle, the lateral position, and the yaw rate. . Further, the guidance posture angle is a posture angle targeted by the host vehicle before reaching the target passing position that is a target position through which the host vehicle passes on the travel path on which the host vehicle travels. It is the lateral position targeted by the host vehicle before reaching the passing position.
本発明によれば、操舵角偏差を縮小させるための操舵支援トルクを、現在位置から目標通過位置へ到達するまでに、自車両が目標とする誘導姿勢角及び誘導横位置に加え、現在の姿勢角、現在の横位置及び現在のヨーレートに基づいて算出する。
このため、自車両が現在位置から目標通過位置へ到達するまで、操舵支援トルクを連続的に変化させることが可能となり、曲率の急激な変化や断続的な変化を抑制して生成した誘導経路を、自車両に走行させることが可能となる。
According to the present invention, the steering assist torque for reducing the steering angle deviation is added to the current attitude by adding the steering attitude torque and the lateral lateral position to which the host vehicle is targeted until reaching the target passing position from the current position. Calculate based on corner, current lateral position and current yaw rate.
For this reason, it is possible to continuously change the steering assist torque until the host vehicle reaches the target passing position from the current position, and the guide route generated by suppressing the sudden change and the intermittent change of the curvature is generated. The vehicle can be made to travel.
以下、本発明の実施形態について図面を参照しつつ説明する。
（第一実施形態）
以下、本発明の第一実施形態について、図面を参照しつつ説明する。
（構成）
図１は、本実施形態の操舵支援装置１の構成を示すブロック図である。
図１中に示すように、本実施形態の操舵支援装置１は、走行路検出部２と、障害部検出部４と、目標通過位置検出部６と、自車姿勢角検出部８と、自車位置検出部１０と、道路曲率検出部１２と、ヨーレート検出部１４を備える。これに加え、本実施形態の操舵支援装置１は、誘導状態算出部１６と、誘導経路生成部１８と、操舵角センサ２０と、目標操舵角算出部２２と、操舵角偏差算出部２４を備える。さらに、本実施形態の操舵支援装置１は、操舵支援トルク算出部２６と、操舵角速度センサ２８と、操舵支援トルク減衰回路３０と、操舵支援トルク出力部３２を備える。
Embodiments of the present invention will be described below with reference to the drawings.
(First embodiment)
Hereinafter, a first embodiment of the present invention will be described with reference to the drawings.
(Constitution)
FIG. 1 is a block diagram showing the configuration of the steering assist device 1 of the present embodiment.
As shown in FIG. 1, the steering assist device 1 of the present embodiment includes a travel path detection unit 2, an obstacle unit detection unit 4, a target passing
走行路検出部２は、例えば、ＣＣＤカメラ等を有して形成し、自車両の周囲（例えば、自車両の進行方向である車両前後方向前方）の環境を画像として取得する。そして、取得した画像に対するエッジ検出等を行うことにより、自車両が走行する走行路を検出する。走行路を検出した走行路検出部２は、検出した走行路を含む情報信号を、目標通過位置検出部６へ出力する。
ここで、走行路検出部２がエッジ検出等を行う対象とは、具体的に、走行車線の境界を示す路上の白線（車線区分線）や、走行路の側壁、ガードレールである。
For example, the travel path detection unit 2 includes a CCD camera and the like, and acquires an environment around the host vehicle (for example, the front of the host vehicle in the front-rear direction). Then, the road on which the host vehicle travels is detected by performing edge detection or the like on the acquired image. The travel path detection unit 2 that has detected the travel path outputs an information signal including the detected travel path to the target passing
Here, the object for which the road detection unit 2 performs edge detection and the like is specifically a white line (lane line) on the road indicating the boundary of the driving lane, a side wall of the driving road, and a guard rail.
障害部検出部４は、例えば、ＣＣＤカメラ等を有して形成し、自車両の周囲（例えば、自車両の進行方向である車両前後方向前方）の環境を画像として取得する。そして、取得した画像に対するエッジ検出等を行い、さらに、オブジェクトの認識を行うことにより、走行路上に存在する障害物を検出する。障害物を検出した走行路検出部２は、検出した障害物を含む情報信号を、目標通過位置検出部６へ出力する。
The obstacle detection unit 4 is formed with a CCD camera, for example, and acquires an environment around the host vehicle (for example, the front of the host vehicle in the front-rear direction). Then, edge detection or the like is performed on the acquired image, and an object is recognized to detect an obstacle present on the travel road. The travel path detection unit 2 that has detected the obstacle outputs an information signal including the detected obstacle to the target passing
ここで、障害部検出部４がオブジェクトの認識を行う対象とは、具体的に、走行路の側壁、ガードレール、走行路上に存在する障害物や他車両、歩行者等である。そして、これらのオブジェクトを、走行路上に存在する障害物として検出する。
目標通過位置検出部６は、走行路検出部２及び障害部検出部４が出力した情報信号に基づき、走行路検出部２が検出した走行路において自車両が通過する目標位置である目標通過位置を検出する。そして、検出した目標通過位置を含む情報信号を、誘導状態算出部１６及び誘導経路生成部１８へ出力する。
Here, the objects on which the obstacle detection unit 4 recognizes objects are specifically side walls of the road, guardrails, obstacles existing on the road, other vehicles, pedestrians, and the like. These objects are detected as obstacles existing on the traveling road.
The target passing
本実施形態では、一例として、目標通過位置検出部６が、図２中に示すように、目標通過位置として、自車両Ｃが通過可能であり且つ幅が最小の部分である最狭部Ｎのうち、幅方向の中心位置Ｐを検出する場合を説明する。
なお、図２は、走行路における自車両Ｃと障害物Ｂとの位置関係を示す図である。また、図２中では、障害物Ｂとして、路上に存在する二台の他車両（小型車両Ｂ１、大型車両Ｂ２）と、走行路の側壁（車幅方向右側の側壁Ｂ３、車幅方向左側の側壁Ｂ４）を示す。さらに、図２中では、当初の位置（例えば、目標通過位置の検出を開始する位置）における自車両Ｃを、符号「Ｃａ」で示し、当初の位置から移動した位置における自車両Ｃを、符号「Ｃｂ」で示す。
In the present embodiment, as an example, as shown in FIG. 2, the target passage
FIG. 2 is a diagram showing a positional relationship between the host vehicle C and the obstacle B on the travel path. In FIG. 2, as the obstacle B, two other vehicles (small vehicle B1 and large vehicle B2) existing on the road, and the side wall of the traveling path (the side wall B3 on the right side in the vehicle width direction, the left side in the vehicle width direction). Side wall B4) is shown. Further, in FIG. 2, the host vehicle C at the initial position (for example, the position where the detection of the target passing position is started) is indicated by reference symbol “Ca”, and the host vehicle C at the position moved from the initial position is indicated by reference symbol Indicated by “Cb”.
また、本実施形態では、一例として、目標通過位置検出部６が、図２中に示すように、自車両Ｃを中心とする予め設定した所定半径Ｄ［ｍ］の範囲内で、最狭部Ｎのうち、幅方向の中心位置Ｐ（目標通過位置）を検出する場合を説明する。
なお、図２中では、当初の位置で自車両Ｃａを中心とする所定半径Ｄの範囲内で検出した最狭部Ｎを、符号「Ｎ１」で示し、自車両Ｃａを中心とする所定半径Ｄの範囲内で検出した中心位置Ｐを、符号「Ｐ１」で示す。また、図２中では、当初の位置から移動した位置で自車両Ｃｂを中心とする所定半径Ｄの範囲内で検出した最狭部Ｎを、符号「Ｎ２」で示し、自車両Ｃｂを中心とする所定半径Ｄの範囲内で検出した中心位置Ｐを、符号「Ｐ２」で示す。さらに、図２中では、自車両Ｃａを中心とする所定半径Ｄの領域を示す境界線を、符号「ＤＬａ」で示し、自車両Ｃｂを中心とする所定半径Ｄの領域を示す境界線を、符号「ＤＬｂ」で示す。
In the present embodiment, as an example, the target passing
In FIG. 2, the narrowest portion N detected within the range of the predetermined radius D centered on the host vehicle Ca at the initial position is indicated by the symbol “N1”, and the predetermined radius D centered on the host vehicle Ca. The center position P detected within the range of is indicated by the symbol “P1”. In FIG. 2, the narrowest portion N detected within a predetermined radius D centered on the host vehicle Cb at the position moved from the initial position is indicated by a symbol “N2”, and the host vehicle Cb is the center. The center position P detected within the range of the predetermined radius D is indicated by the symbol “P2”. Further, in FIG. 2, a boundary line indicating a region of the predetermined radius D centered on the host vehicle Ca is indicated by a symbol “DLa”, and a boundary line indicating a region of the predetermined radius D centered on the host vehicle Cb is This is indicated by the symbol “DLb”.
ここで、所定半径Ｄは、例えば、図３中に示すように、自車両Ｃの車速Ｖに応じて設定する。なお、図３は、予め設定した所定半径Ｄと自車両Ｃの車速Ｖとの関係を示す図である。
具体的には、図３中に示すように、車速がＶ１（例えば、１０［ｋｍ／ｈ］）以下の領域では、所定半径ＤをＤ１（例えば、３［ｍ］）に設定する。そして、車速がＶ１を超える領域（例えば、１０［ｋｍ／ｈ］を超える速度域）では、車速の増加に応じて、所定半径Ｄを増加（例えば、３［ｍ］を超える距離で増加）させる。
Here, the predetermined radius D is set according to the vehicle speed V of the host vehicle C, for example, as shown in FIG. FIG. 3 is a diagram showing a relationship between a predetermined radius D set in advance and the vehicle speed V of the host vehicle C.
Specifically, as shown in FIG. 3, in a region where the vehicle speed is V 1 (for example, 10 [km / h]) or less, the predetermined radius D is set to D 1 (for example, 3 [m]). In a region where the vehicle speed exceeds V 1 (for example, a speed region exceeding 10 [km / h]), the predetermined radius D is increased (for example, increased at a distance exceeding 3 [m]) as the vehicle speed increases. Let
また、目標通過位置検出部６は、予め設定した第一所定時間間隔で、目標通過位置（中心位置Ｐ）を検出する。ここで、上記の第一所定時間は、例えば、５０［ｍｓｅｃ］や１００［ｍｓｅｃ］として、予め設定する。なお、本実施形態では、一例として、第一所定時間間隔を、１００［ｍｓｅｃ］と設定した場合を説明する。
自車姿勢角検出部８は、例えば、Ｇセンサ（加速度センサ）を用いて形成し、自車両の現在の姿勢角を検出する。そして、自車姿勢角検出部８は、検出した現在の姿勢角を含む情報信号を、誘導状態算出部１６及び誘導経路生成部１８へ出力する。
The target passage
The own vehicle attitude angle detection unit 8 is formed using, for example, a G sensor (acceleration sensor), and detects the current attitude angle of the own vehicle. Then, the vehicle attitude angle detection unit 8 outputs an information signal including the detected current attitude angle to the guidance
自車位置検出部１０は、例えば、ＧＰＳ（Ｇｌｏｂａｌ Ｐｏｓｉｔｉｏｎｉｎｇ Ｓｙｓｔｅｍ）を用いて形成し、自車両の現在位置を検出する。そして、自車姿勢角検出部８は、検出した現在位置を含む情報信号を、誘導状態算出部１６及び誘導経路生成部１８へ出力する。なお、自車両の現在位置とは、自車両が走行している走行路における、横位置（道幅方向の位置）である。
The own vehicle
道路曲率検出部１２は、例えば、カーナビゲーションシステム（Ａｕｔｏｍｏｔｉｖｅ ｎａｖｉｇａｔｉｏｎ ｓｙｓｔｅｍ）を用いて形成し、自車両が走行する走行路の曲率を検出する。そして、自車姿勢角検出部８は、検出した曲率を含む情報信号を、誘導状態算出部１６及び誘導経路生成部１８へ出力する。
ヨーレート検出部１４は、例えば、ジャイロスコープ（ｇｙｒｏｓｃｏｐｅ）等、ヨーレート（Ｙａｗ Ｒａｔｅ）を検出可能なセンサを用いて形成し、自車両の現在のヨーレートを検出する。そして、ヨーレート検出部１４は、検出した現在のヨーレートを含む情報信号を、誘導経路生成部１８へ出力する。
The road
The yaw
誘導状態算出部１６は、目標通過位置検出部６、自車姿勢角検出部８、自車位置検出部１０及び道路曲率検出部１２が出力した情報信号に基づき、誘導姿勢角と誘導横位置を算出する。そして、誘導状態算出部１６は、算出した誘導姿勢角及び誘導横位置を含む情報信号を、誘導経路生成部１８へ出力する。
ここで、誘導姿勢角は、目標通過位置検出部６が検出した目標通過位置へ到達するまでに自車両Ｃが目標とする姿勢角である。また、誘導横位置は、目標通過位置検出部６が検出した目標通過位置へ到達するまでに自車両Ｃが目標とする横位置である。
The guidance
Here, the guidance posture angle is a posture angle targeted by the host vehicle C before reaching the target passage position detected by the target passage
また、誘導姿勢角の算出は、例えば、自車両Ｃの進行方向（前後方向）が走行路の延在方向（長さ方向）と平行となるように行う。
また、誘導横位置の算出は、例えば、誘導横位置の算出時における自車両Ｃの横位置と目標通過位置における自車両Ｃの横位置との偏差が少なくなるように行う。
Further, the calculation of the guidance posture angle is performed so that the traveling direction (front-rear direction) of the host vehicle C is parallel to the extending direction (length direction) of the travel path, for example.
Further, the calculated lateral lateral position is calculated so that, for example, the deviation between the lateral position of the host vehicle C and the lateral position of the host vehicle C at the target passing position when calculating the guided lateral position is reduced.
誘導経路生成部１８は、目標通過位置検出部６、自車姿勢角検出部８、自車位置検出部１０、道路曲率検出部１２、ヨーレート検出部１４及び誘導状態算出部１６が出力した情報信号に基づき、誘導経路を生成する。そして、誘導経路生成部１８は、生成した誘導経路を含む情報信号を、目標操舵角算出部２２へ出力する。
ここで、誘導経路は、走行路検出部２が検出した走行路において、自車両Ｃが走行すべき経路である。
誘導経路の生成は、以下の式（１）を用いて算出する経路曲率ｋ（ｓ）と、以下の式（２）を用いて算出する姿勢角φ（ｓ）と、以下の式（３）を用いて算出する横位置ｘ（ｓ）に基づいて行う。
The guidance
Here, the guidance route is a route on which the host vehicle C should travel on the travel route detected by the travel route detection unit 2.
The guidance route is generated by using a path curvature k (s) calculated using the following equation (1), an attitude angle φ (s) calculated using the following equation (2), and the following equation (3): This is performed based on the lateral position x (s) calculated using.
なお、上記の式（１）〜（３）中において、ｋ０：現在の経路曲率、φ０：現在の姿勢角、ｘ０：現在の横位置である。
また、上記の式（１）〜（３）中のλ（λ１、λ２、λ３）は、経路係数（誘導経路の生成に用いる係数）であり、以下の式（４）で算出する。
ここで、式（１）〜（３）中のλは、誘導位置における経路曲率ｋ（ｙ）＝０、誘導位置における姿勢角φ（ｙ）＝０、誘導位置における横位置ｘ（ｙ）＝ζとして算出する。
In the above formulas (1) to (3), k 0 is the current path curvature, φ 0 is the current posture angle, and x 0 is the current lateral position.
Further, λ (λ 1 , λ 2 , λ 3 ) in the above formulas (1) to (3) is a path coefficient (coefficient used for generating the guidance path), and is calculated by the following formula (4). .
Here, λ in the equations (1) to (3) is the path curvature k (y) = 0 at the guidance position, the posture angle φ (y) = 0 at the guidance position, and the lateral position x (y) = at the guidance position. Calculate as ζ.
そして、上記の式（４）を用いて算出した経路係数λ（λ１、λ２、λ３）を、上記の式（１）〜（３）へ代入し、さらに、以下の式（５）で算出する誘導距離ｓを上記の式（１）〜（３）へ代入して、誘導経路を生成するための誘導点を算出する。
ｓ＝Ｔ×Ｖ …（５）
ここで、上記の式（５）中では、Ｔ：誘導距離の算出時間、Ｖ：自車両Ｃの車速である。
Then, the path coefficients λ (λ 1 , λ 2 , λ 3 ) calculated using the above equation (4) are substituted into the above equations (1) to (3), and further, the following equation (5) Substituting the guidance distance s calculated in (1) into the above equations (1) to (3), the guidance point for generating the guidance route is calculated.
s = T × V (5)
Here, in the above equation (5), T is the calculation time of the guidance distance, and V is the vehicle speed of the host vehicle C.
なお、本実施形態では、一例として、誘導距離の算出時間Ｔを、０．３［秒］とする場合を説明する。
そして、誘導経路生成部１８は、上述した式（１）〜（５）を用いて、上記の誘導点を複数箇所算出し、これらの算出した誘導点の連続した集合により形成した線を、誘導経路として生成する。
操舵角センサ２０は、例えば、操舵輪を回転可能に支持するステアリングコラムに設ける。また、操舵角センサ２０は、自車両Ｃの運転者による、操舵輪の現在の回転角度（操舵操作量）である現在操舵角を検出する。そして、操舵角センサ２０は、検出した操舵輪の現在操舵角を含む情報信号を、目標操舵角算出部２２及び操舵角偏差算出部２４へ出力する。なお、以下の説明では、現在操舵角を、「現在操舵角θ」と記載する場合がある。
In the present embodiment, as an example, a case where the calculation time T of the guidance distance is 0.3 [seconds] will be described.
And the guidance path | route production |
The
ここで、近年の車両は、操舵輪の操舵角を検出可能なセンサを、標準的に備えている場合が多い。このため、本実施形態では、操舵角センサ２０として、自車両Ｃに既存のセンサである、操舵輪の操舵角を検出可能なセンサを用いる場合について説明する。
目標操舵角算出部２２は、誘導経路生成部１８及び操舵角センサ２０が出力した情報信号に基づき、目標操舵角を算出する。そして、目標操舵角算出部２２は、算出した目標操舵角を含む情報信号を、操舵角偏差算出部２４へ出力する。なお、以下の説明では、目標操舵角を、「目標操舵角θ*」と記載する場合がある。
Here, recent vehicles often have a sensor that can detect the steering angle of the steered wheels as a standard. For this reason, in this embodiment, the case where the sensor which can detect the steering angle of the steering wheel which is an existing sensor in the own vehicle C is used as the
The target steering
ここで、目標操舵角は、誘導経路生成部１８が生成した誘導経路を自車両Ｃが走行するために操舵輪（ステアリングホイール）の目標とする回転角度である。
目標操舵角θ*を算出する際には、例えば、走行路上における自車両Ｃの現在位置と、現在位置における操舵輪の回転角度から、上述した誘導点に到達するために必要な操舵角を算出する。そして、この算出した操舵角を、目標操舵角θ*とする。
Here, the target steering angle is a rotation angle that is a target of the steering wheel (steering wheel) in order for the vehicle C to travel on the guidance route generated by the
When calculating the target steering angle θ * , for example, the steering angle required to reach the aforementioned guidance point is calculated from the current position of the host vehicle C on the road and the rotation angle of the steering wheel at the current position. To do. The calculated steering angle is set as a target steering angle θ * .
ここで、本実施形態では、一例として、予め、目標操舵角算出部２２に車両運動モデルを記憶させておき、この車両運動モデルを、目標操舵角θ*の算出に用いる場合を説明する。これにより、本実施形態の操舵支援装置１では、車両運動モデルを目標操舵角θ*の算出に用いない場合と比較して、より正確な目標操舵角θ*の算出が可能となる。
なお、車両運動モデルとは、例えば、自車両Ｃの走行時における、操舵角と速度（車速）に応じて生じる車両の運動(ヨーレート等)を示すモデルであり、車両に個別のパラメータである。
Here, in the present embodiment, as an example, a case will be described in which a vehicle motion model is stored in advance in the target steering
The vehicle motion model is, for example, a model indicating vehicle motion (yaw rate or the like) generated according to the steering angle and speed (vehicle speed) when the host vehicle C is traveling, and is a parameter specific to the vehicle.
操舵角偏差算出部２４は、目標操舵角算出部２２及び操舵角センサ２０が出力した情報信号に基づき、操舵角偏差を算出する。そして、操舵角偏差算出部２４は、算出した操舵角偏差を含む情報信号を、操舵支援トルク算出部２６及び操舵支援トルク減衰回路３０へ出力する。
ここで、操舵角偏差とは、目標操舵角算出部２２が算出した目標操舵角θ*と操舵角センサ２０が検出した現在操舵角θとの差分である。なお、以下の説明では、操舵角偏差を、「操舵角偏差δθ」と記載する場合がある。
The steering
Here, the steering angle deviation is a difference between the target steering angle θ * calculated by the target steering
操舵角偏差δθは、現在操舵角θから目標操舵角θ*を減算して算出する。したがって、操舵角偏差δθは、以下の式（６）により算出する。
δθ＝θ−θ* … （６）
操舵支援トルク算出部２６は、操舵角偏差算出部２４が出力した情報信号に基づき、トルク指令信号を算出する。そして、操舵支援トルク算出部２６は、算出したトルク指令信号を含む情報信号を、操舵支援トルク減衰回路３０へ出力する。
The steering angle deviation δθ is calculated by subtracting the target steering angle θ * from the current steering angle θ. Therefore, the steering angle deviation δθ is calculated by the following equation (6).
δθ = θ−θ * (6)
The steering assist
ここで、トルク指令信号とは、操舵角偏差算出部２４が算出した操舵角偏差δθを縮小させるための操舵支援トルクの指令値である。なお、以下の説明では、トルク指令信号を、「トルク指令値Ｔｏ」と記載する場合がある。
本実施形態では、一例として、トルク指令値Ｔｏを、以下に示す式（７）を用いて算出する場合について説明する。
Ｔｏ＝Ｚ×δθ＝Ｚ×（θ−θ＊） … （７）
Here, the torque command signal is a command value of the steering assist torque for reducing the steering angle deviation δθ calculated by the steering angle
In the present embodiment, as an example, the torque command value T o, will be described be calculated using equation (7) shown below.
T o = Z × δθ = Z × (θ−θ * ) (7)
なお、上記の式（７）中において、「Ｚ」は、目標操舵角算出部２２に記憶させた目標操舵角θ*への収束の速さに対応する係数である。この係数は、固定の定数、または、車速等に応じた変数として設定する。また、上記の式（７）中に示されているように、トルク指令値Ｔｏは、操舵角偏差δθに比例する値である。
In the above formula (7), “Z” is a coefficient corresponding to the convergence speed to the target steering angle θ * stored in the target steering
また、操舵支援トルク算出部２６は、予め設定した第二所定時間間隔で、トルク指令値Ｔｏを算出する。ここで、上記の第二所定時間は、例えば、５０［ｍｓｅｃ］や１００［ｍｓｅｃ］として、予め設定する。なお、本実施形態では、一例として、第二所定時間間隔を、１００［ｍｓｅｃ］と設定した場合を説明する。したがって、本実施形態では、第一所定時間間隔と第二所定時間間隔を、同じ値に設定する。
Further, the steering assist
操舵角速度センサ２８は、操舵角センサ２０と同様、例えば、操舵輪を回転可能に支持するステアリングコラムに設ける。また、操舵角速度センサ２８は、自車両Ｃの運転者による、操舵輪の現在の操舵時における回転角速度である操舵角速度を検出する。そして、この検出した操舵角速度を含む情報信号を、操舵支援トルク減衰回路３０へ出力する。なお、以下の説明では、操舵角速度を、「操舵角速度θ’」と記載する場合がある。
Similar to the
ここで、近年の車両は、操舵輪の操舵角速度を検出可能なセンサを、標準的に備えている場合が多い。このため、本実施形態では、操舵角速度センサ２８として、自車両Ｃに既存のセンサである、操舵輪の操舵角速度を検出可能なセンサを用いた場合について説明する。
Here, recent vehicles often include a sensor that can detect the steering angular velocity of the steered wheels as a standard. For this reason, in this embodiment, the case where the sensor which can detect the steering angular velocity of the steering wheel which is an existing sensor in the own vehicle C is used as the steering
操舵支援トルク減衰回路３０は、操舵角偏差算出部２４、操舵角速度センサ２８及び操舵支援トルク算出部２６が出力した情報信号に基づき、操舵支援トルク算出部２６が算出したトルク指令値Ｔｏを減衰させる減衰指令信号を算出する。そして、操舵支援トルク減衰回路３０は、算出した減衰指令信号によりトルク指令値Ｔｏを減衰させたトルク減衰指令値Ｔを含む情報信号を、操舵支援トルク出力部３２へ出力する。
Steering assist
ここで、操舵支援トルク減衰回路３０は、一例として、トルク減衰指令値Ｔを、以下に示す式（８）を用いて算出する場合について説明する。
Ｔ＝（θ−θ＊）×θ’＋Ｔｏ … （８）
したがって、本実施形態の操舵支援トルク減衰回路３０は、操舵角速度θ’に応じて、トルク指令値Ｔｏ（トルク指令信号）の減衰度合いが変化するように、減衰指令信号Ｔを算出する。
Here, as an example, a case where the steering assist
T = (θ−θ * ) × θ ′ + T o (8)
Accordingly, the steering assist
トルク減衰指令値Ｔを算出した操舵支援トルク減衰回路３０は、この算出したトルク減衰指令値Ｔを含む指令信号を、操舵支援トルク出力部３２へ出力する。
操舵支援トルク出力部３２は、公知の電動パワーステアリング（Ｅｌｅｃｔｒｉｃ Ｐｏｗｅｒ Ｓｔｅｅｒｉｎｇ）であり、操舵輪へ操舵支援トルクを出力可能な電動モータを有する。
The steering assist
The steering assist
また、操舵支援トルク出力部３２は、操舵支援トルク減衰回路３０が出力した指令信号に基づき、電動モータを制御する。これにより、操舵支援トルク出力部３２は、操舵支援トルク減衰回路３０が算出したトルク減衰指令値Ｔに応じた操舵支援トルクを、操舵輪へ出力する。
なお、操舵支援トルク出力部３２が行なう電動モータの制御は、一般的に、電動モータへ供給する電流を制御して行う。したがって、本実施形態においても、電動モータへ供給する電流を制御して電動モータの制御を行い、トルク減衰指令値Ｔに相当する操舵支援トルクを、操舵輪へ出力する。
The steering assist
The control of the electric motor performed by the steering assist
（動作）
次に、図１から図３を参照しつつ、図４及び図５を用いて、本実施形態の操舵支援装置１が行なう動作の一例について説明する。
図４は、本実施形態の操舵支援装置１が行う処理を示すフローチャートである。
図４中に示すフローチャートは、自車両Ｃが走行しており、自車両Ｃの運転者によって、操舵支援装置１を作動させるスイッチが操作（ＯＮ）された状態からスタートする（図４中に示す「ＳＴＡＲＴ」）。
(Operation)
Next, an example of the operation performed by the steering assist device 1 of the present embodiment will be described with reference to FIGS. 1 to 3 and FIGS. 4 and 5.
FIG. 4 is a flowchart showing processing performed by the steering assist device 1 of the present embodiment.
The flowchart shown in FIG. 4 starts from a state in which the host vehicle C is traveling and a switch for operating the steering assist device 1 is operated (ON) by the driver of the host vehicle C (shown in FIG. 4). “START”).
操舵支援装置１を作動させると、自車位置検出部１０が、自車両Ｃの現在位置を検出（ステップＳ１００に示す「車両横位置の検出」）する。そして、自車両Ｃの現在位置を検出した自車位置検出部１０は、算出した現在位置を含む情報信号を、誘導状態算出部１６及び誘導経路生成部１８へ出力する。ステップＳ１００において、自車両Ｃの現在位置を検出すると、操舵支援装置１が行う処理は、ステップＳ１０２へ移行する。
ステップＳ１０２では、自車姿勢角検出部８により、自車両Ｃの現在の姿勢角を検出（ステップＳ１０２に示す「車両姿勢角の検出」）する。これに加え、ステップＳ１０２では、ヨーレート検出部１４により、自車両Ｃの現在のヨーレートを検出する。
When the steering assist device 1 is operated, the host vehicle
In step S102, the current vehicle posture angle detection unit 8 detects the current posture angle of the host vehicle C ("detection of vehicle posture angle" shown in step S102). In addition, in step S102, the
そして、自車両Ｃの現在の姿勢角を検出した自車姿勢角検出部８は、検出した現在の姿勢角を含む情報信号を、誘導状態算出部１６及び誘導経路生成部１８へ出力する。これに加え、自車両Ｃの現在のヨーレートを検出したヨーレート検出部１４は、検出した現在のヨーレートを含む情報信号を、誘導経路生成部１８へ出力する。ステップＳ１０２において、現在の姿勢角及びヨーレートを検出すると、操舵支援装置１が行う処理は、ステップＳ１０４の処理へ移行する。
Then, the vehicle attitude angle detection unit 8 that has detected the current attitude angle of the host vehicle C outputs an information signal including the detected current attitude angle to the guidance
ステップＳ１０４では、道路曲率検出部１２により、自車両Ｃが走行する走行路の曲率を検出（ステップＳ１０４に示す「経路曲率の検出」）する。そして、走行路の曲率を検出した道路曲率検出部１２は、検出した曲率を含む情報信号を、誘導状態算出部１６及び誘導経路生成部１８へ出力する。ステップＳ１０４において、走行路の曲率を検出すると、操舵支援装置１が行う処理は、ステップＳ１０６へ移行する。
In step S104, the road
ステップＳ１０６では、走行路検出部２により、自車両Ｃが走行する走行路を検出（ステップＳ１０６に示す「走行路検出」）する。そして、走行路を検出した走行路検出部２は、検出した走行路を含む情報信号を、目標通過位置検出部６へ出力する。ステップＳ１０６において、走行路を検出すると、操舵支援装置１が行う処理は、ステップＳ１０８へ移行する。
In step S106, the travel path detection unit 2 detects the travel path on which the host vehicle C travels ("travel path detection" shown in step S106). Then, the travel path detection unit 2 that has detected the travel path outputs an information signal including the detected travel path to the target passage
ステップＳ１０８では、障害部検出部４により、走行路上に存在する障害物を検出（ステップＳ１０８に示す「障害物検出」）する。そして、障害物を検出した障害部検出部４は、検出した障害物を含む情報信号を、目標通過位置検出部６へ出力する。ステップＳ１０８において、障害物を検出すると、操舵支援装置１が行う処理は、ステップＳ１１０へ移行する。
In step S108, the obstacle detection unit 4 detects an obstacle present on the traveling road ("obstacle detection" shown in step S108). Then, the obstacle detection unit 4 that has detected the obstacle outputs an information signal including the detected obstacle to the target passage
ステップＳ１１０では、目標通過位置検出部６により、最狭部Ｎのうち幅方向の中心位置Ｐを検出して、目標通過位置を検出（ステップＳ１１０に示す「目標通過位置の検出」）する。そして、目標通過位置を検出した目標通過位置検出部６は、検出した目標通過位置を含む情報信号を、誘導状態算出部１６及び誘導経路生成部１８へ出力する。ステップＳ１１０において、目標通過位置を検出すると、操舵支援装置１が行う処理は、ステップＳ１１２へ移行する。
In step S110, the target passage
ステップＳ１１２では、誘導状態算出部１６により、誘導姿勢角と誘導横位置を算出（ステップＳ１１２に示す「誘導姿勢角及び誘導横位置の算出」）する。そして、誘導姿勢角及び誘導横位置を算出した誘導状態算出部１６は、誘導姿勢角及び誘導横位置を含む情報信号を、誘導経路生成部１８へ出力する。ステップＳ１１２において、誘導姿勢角及び誘導横位置を算出すると、操舵支援装置１が行う処理は、ステップＳ１１４へ移行する。
In step S112, the guidance
ステップＳ１１４では、誘導経路生成部１８により、誘導位置における経路曲率ｋを算出（ステップＳ１１４に示す「誘導位置における経路曲率を算出」）する。ステップＳ１１４において、誘導位置における経路曲率ｋを検出すると、操舵支援装置１が行う処理は、ステップＳ１１６へ移行する。
ステップＳ１１６では、誘導経路生成部１８により、経路係数λ（λ１、λ２、λ３）を算出（ステップＳ１１６に示す「経路係数（λ１、λ２、λ３）の算出」）する。ステップＳ１１６において、経路係数λを算出すると、操舵支援装置１が行う処理は、ステップＳ１１８へ移行する。
In step S114, the route curvature k at the guidance position is calculated by the guidance route generation unit 18 ("calculate the path curvature at the guidance position" shown in step S114). When the path curvature k at the guidance position is detected in step S114, the processing performed by the steering assist device 1 proceeds to step S116.
In step S116, the guidance
ステップＳ１１８では、誘導経路生成部１８により、誘導経路を生成するための誘導点を複数箇所算出（ステップＳ１１８に示す「誘導点の算出」）する。ステップＳ１１８において、複数箇所の誘導点を算出すると、操舵支援装置１が行う処理は、ステップＳ１２０へ移行する。
ステップＳ１２０では、誘導経路生成部１８により、複数箇所の誘導点の連続した集合により形成した線を、誘導経路として生成（ステップＳ１２０に示す「誘導経路の生成」）する。ステップＳ１２０において、誘導経路を生成すると、操舵支援装置１が行う処理は、ステップＳ１２２へ移行する。
In step S118, the guide
In step S120, the guidance
ステップＳ１２２では、操舵支援トルク出力部３２により、電動モータの制御（ステップＳ１２２に示す「ＥＰＳを制御」）を行い、トルク減衰指令値Ｔに相当する操舵支援トルクを操舵輪へ出力する。
トルク減衰指令値Ｔに相当する操舵支援トルクを操舵輪へ出力すると、自車両Ｃが誘導経路を走行するための操舵支援トルクが出力された操舵輪を、運転者が操舵することとなる。
In step S122, the steering assist
When the steering assist torque corresponding to the torque attenuation command value T is output to the steered wheels, the driver steers the steered wheels from which the steering assist torque for causing the vehicle C to travel on the guide route is output.
したがって、トルク減衰指令値Ｔに相当する操舵支援トルクを操舵輪へ出力すると、例えば、図５中に示すように、自車両Ｃの走行経路を、誘導経路Ｒとするための操舵支援トルクが出力された操舵輪を、運転者が操舵することとなる。なお、図５は、走行路における自車両Ｃと障害物Ｂとの位置関係を示す図である。また、図５中では、障害物Ｂ（小型車両Ｂ１、大型車両Ｂ２、車幅方向右側の側壁Ｂ３、車幅方向左側の側壁Ｂ４）を、図２中と同様に示す。さらに、図５中では、最狭部Ｎ、中心位置Ｐ、自車両Ｃを中心とする所定半径Ｄ、自車両Ｃを中心とする所定半径Ｄの領域を示す境界線ＤＬを、図２中と同様に示す。 Therefore, when the steering assist torque corresponding to the torque attenuation command value T is output to the steered wheels, for example, as shown in FIG. 5, the steering assist torque for setting the traveling route of the host vehicle C as the guide route R is output. The driver steers the steered wheels. FIG. 5 is a diagram showing the positional relationship between the host vehicle C and the obstacle B on the travel path. Further, in FIG. 5, the obstacle B (small vehicle B1, large vehicle B2, side wall B3 on the right side in the vehicle width direction, and side wall B4 on the left side in the vehicle width direction) is shown in the same manner as in FIG. Further, in FIG. 5, the narrowest portion N, the center position P, the predetermined radius D centered on the host vehicle C, and the boundary line DL indicating the region of the predetermined radius D centered on the host vehicle C are shown in FIG. The same is shown.
ここで、操舵支援トルク算出部２６が算出したトルク指令信号は、操舵角偏差算出部２４が算出した操舵角偏差δθを縮小させるための操舵支援トルクの指令値である。これに加え、操舵角偏差δθを、現在位置から目標通過位置へ到達するまでに、自車両Ｃが目標とする誘導姿勢角及び誘導横位置に加え、現在の姿勢角、現在の横位置及び現在のヨーレートに基づいて算出する。
Here, the torque command signal calculated by the steering assist
したがって、走行する自車両Ｃが現在位置から目標通過位置へ到達するまでの間、操舵支援トルクを連続的に変化させることが可能となる。これにより、曲率の急激な変化や断続的な変化を抑制して生成した誘導経路Ｒを、自車両Ｃに走行させることが可能となる。
ステップＳ１２２において電動モータを制御し、トルク減衰指令値Ｔに相当する操舵支援トルクを操舵輪へ出力すると、操舵支援装置１が行う処理は、ステップＳ１００の処理に復帰（図４中に示す「ＲＥＴＵＲＮ」）する。
Therefore, the steering assist torque can be continuously changed until the traveling host vehicle C reaches the target passing position from the current position. As a result, it is possible to cause the host vehicle C to travel on the guidance route R generated by suppressing a rapid change or intermittent change in curvature.
When the electric motor is controlled in step S122 and the steering assist torque corresponding to the torque attenuation command value T is output to the steered wheels, the processing performed by the steering assist device 1 returns to the processing in step S100 ("RETURN" shown in FIG. 4). )).
なお、上述したように、本実施形態の操舵支援装置１の動作で実施する操舵支援方法は、目標通過位置を検出する目標通過位置検出ステップと、誘導姿勢角を算出する誘導姿勢角算出ステップと、誘導横位置を算出する誘導横位置算出ステップを有する。これに加え、上述した誘導姿勢角、誘導横位置、現在の姿勢角、現在の横位置及び現在のヨーレートに基づき、誘導経路Ｒを生成する誘導経路生成ステップを有する。さらに、目標操舵角を算出する目標操舵角算出ステップと、操舵角偏差を算出する操舵角偏差算出ステップと、操舵支援トルクを算出する操舵支援トルク算出ステップと、操舵支援トルクを操舵輪へ出力する操舵支援トルク出力ステップを有する。 As described above, the steering support method implemented by the operation of the steering support device 1 of the present embodiment includes the target passing position detecting step for detecting the target passing position, and the guiding posture angle calculating step for calculating the guiding posture angle. And a guide lateral position calculating step for calculating the guide lateral position. In addition, there is a guide route generation step for generating the guide route R based on the above-described guide posture angle, guide lateral position, current posture angle, current lateral position, and current yaw rate. Furthermore, a target steering angle calculating step for calculating a target steering angle, a steering angle deviation calculating step for calculating a steering angle deviation, a steering assist torque calculating step for calculating steering assist torque, and outputting the steering assist torque to the steered wheels. A steering assist torque output step;
以上により、誘導状態算出部１６は、誘導姿勢角算出部及び誘導横位置算出部に対応する。また、自車姿勢角検出部８は、現在姿勢角検出部に対応する。また、自車位置検出部１０は、現在横位置検出部に対応する。また、操舵角センサ２０は、現在操舵角検出部に対応する。
As described above, the guidance
同様に、ステップＳ１１０は、目標通過位置検出ステップに対応する。また、ステップＳ１１２は、誘導姿勢角算出ステップ及び誘導横位置算出ステップに対応する。また、ステップＳ１１４からＳ１２０は、誘導経路生成ステップ、目標操舵角算出ステップ、操舵角偏差算出ステップ、操舵支援トルク算出ステップに対応する。また、ステップＳ１２２は、操舵支援トルク出力ステップに対応する。 Similarly, step S110 corresponds to a target passage position detection step. Step S112 corresponds to a guidance posture angle calculation step and a guidance lateral position calculation step. Steps S114 to S120 correspond to a guidance route generation step, a target steering angle calculation step, a steering angle deviation calculation step, and a steering assist torque calculation step. Step S122 corresponds to a steering assist torque output step.
（第一実施形態の効果）
（１）誘導経路生成部１８が、誘導姿勢角、誘導横位置、自車両Ｃの現在の姿勢角、横位置及びヨーレートに基づいて、自車両の走行路において自車両が走行すべき誘導経路を生成する。
このため、走行する自車両Ｃが現在位置から目標通過位置へ到達するまでの間、操舵支援トルクを連続的に変化させることが可能となる。
その結果、曲率の急激な変化や断続的な変化を抑制して生成した誘導経路Ｒを、自車両Ｃに走行させることが可能となる。
また、操舵角の変化が、障害物の形状に影響されることを抑制することが可能となるため、走行中の運転者が操舵角を保持したい場合であっても、操舵角の変化を抑制することが可能となる。
(Effects of the first embodiment)
(1) Based on the guidance posture angle, the guidance lateral position, the current posture angle of the subject vehicle C, the lateral position, and the yaw rate, the guidance
For this reason, it is possible to continuously change the steering assist torque until the traveling own vehicle C reaches the target passing position from the current position.
As a result, it is possible to cause the host vehicle C to travel on the guidance route R generated while suppressing a rapid change or intermittent change in curvature.
In addition, since it is possible to suppress changes in the steering angle from being affected by the shape of the obstacle, even if the traveling driver wants to maintain the steering angle, the change in the steering angle is suppressed. It becomes possible to do.
（２）目標通過位置検出部６が、目標通過位置として、自車両Ｃが通過可能であり且つ幅が最小の部分である最狭部Ｎの、幅方向の中心位置Ｐを検出する。
その結果、走行路上において自車両Ｃが障害物へ接触する可能性が高い位置における、自車両Ｃの横位置と姿勢角を、適正な状態に誘導することが可能となるため、自車両Ｃが障害物へ接触する可能性を低減することが可能となる。
(2) The target passing
As a result, it is possible to guide the lateral position and posture angle of the host vehicle C to an appropriate state at a position where the host vehicle C is likely to contact an obstacle on the travel road. The possibility of contact with an obstacle can be reduced.
また、走行路上において、最狭部Ｎを構成する障害物以外の物体を考慮して目標通過位置を検出する場合と比較して、目標通過位置の検出に要する演算処理のステップを減少させることが可能となる。また、最狭部Ｎを構成する障害物以外の物体を考慮して目標通過位置を検出する場合と比較して、目標通過位置の検出に要する演算処理の周期を短縮することが可能となる。
これにより、操舵輪に対する操舵支援トルクの出力が遅延することを、抑制することが可能となり、操舵制御のレスポンスを向上させることが可能となる。
Further, compared to the case where the target passage position is detected in consideration of an object other than the obstacle constituting the narrowest portion N on the traveling road, the number of calculation processing steps required for detection of the target passage position can be reduced. It becomes possible. In addition, it is possible to shorten the calculation processing cycle required for detecting the target passage position, compared to the case where the target passage position is detected in consideration of an object other than the obstacle constituting the narrowest portion N.
As a result, it is possible to suppress a delay in the output of the steering assist torque for the steered wheels, and to improve the response of the steering control.
（３）目標通過位置検出部６が、自車両Ｃを中心とする予め設定した所定半径Ｄの範囲内で、目標通過位置を検出する。
その結果、例えば、自車両Ｃの車速Ｖに応じた範囲等、運転者が意識しやすい範囲内で目標通過位置を検出することが可能となり、所定半径Ｄを設定しない場合と比較して、操舵支援トルクの急激な変化や断続的な変化を、さらに抑制することが可能となる。
(3) The target passing
As a result, for example, the target passing position can be detected within a range that the driver can easily recognize, such as a range according to the vehicle speed V of the host vehicle C, and the steering is compared with the case where the predetermined radius D is not set. It is possible to further suppress sudden changes and intermittent changes in the support torque.
（４）目標通過位置検出部６が、予め設定した第一所定時間間隔で目標通過位置を検出する。これに加え、操舵支援トルク算出部２６が、予め設定した第二所定時間間隔で操舵支援トルクを算出する。
その結果、実時間（Ｒｅａｌ Ｔｉｍｅ）で目標通過位置を検出した上で、実時間で操舵支援トルクを算出するため、所定時間間隔で処理を行わない場合と比較して、操舵支援トルクの急激な変化や断続的な変化を、さらに抑制することが可能となる。
(4) The target passage
As a result, in order to calculate the steering assist torque in real time after detecting the target passing position in real time (Real Time), compared with the case where the processing is not performed at predetermined time intervals, the steering assist torque is drastically reduced. It becomes possible to further suppress changes and intermittent changes.
（５）誘導経路生成部１８が、誘導点を複数箇所算出し、これらの算出した誘導点の連続した集合により形成した線を、誘導経路として生成する。
その結果、誘導姿勢角、誘導横位置、自車両Ｃの現在の姿勢角、横位置及びヨーレートに基づいて、連続的な曲線状の誘導経路を生成することが可能となる。
(5) The guidance
As a result, it is possible to generate a continuous curvilinear guidance route based on the guidance attitude angle, the guidance lateral position, the current attitude angle of the host vehicle C, the lateral position, and the yaw rate.
（６）本実施形態の操舵支援方法では、誘導経路生成ステップにおいて、誘導姿勢角、誘導横位置、自車両Ｃの現在の姿勢角、横位置及びヨーレートに基づいて、自車両の走行路において自車両が走行すべき誘導経路を生成する。
このため、走行する自車両Ｃが現在位置から目標通過位置へ到達するまでの間、操舵支援トルクを連続的に変化させることが可能となる。
その結果、曲率の急激な変化や断続的な変化を抑制して生成した誘導経路Ｒを、自車両Ｃに走行させることが可能となる。これに加え、操舵角の変化が、障害物の形状に影響されることを抑制することが可能となるため、走行中の運転者が操舵角を保持したい場合であっても、操舵角の変化を抑制することが可能となる。
(6) In the steering assist method according to the present embodiment, in the guidance route generation step, the driver's own vehicle travel path is determined based on the guidance attitude angle, the guidance lateral position, the current attitude angle of the host vehicle C, the lateral position, and the yaw rate. A guidance route for the vehicle to travel is generated.
For this reason, it is possible to continuously change the steering assist torque until the traveling own vehicle C reaches the target passing position from the current position.
As a result, it is possible to cause the host vehicle C to travel on the guidance route R generated while suppressing a rapid change or intermittent change in curvature. In addition, since it is possible to suppress the change in the steering angle from being affected by the shape of the obstacle, the change in the steering angle can be achieved even when the traveling driver wants to maintain the steering angle. Can be suppressed.
（変形例）
（１）本実施形態の操舵支援装置１では、目標通過位置検出部６が、目標通過位置として、自車両Ｃが通過可能であり且つ幅が最小の部分である最狭部Ｎの、幅方向の中心位置Ｐを検出したが、目標通過位置は、これに限定するものではない。すなわち、例えば、最狭部Ｎの幅が、自車両Ｃが通過可能な幅に対して大きな余裕がある場合等は、目標通過位置として、最狭部Ｎの、幅方向の中心位置Ｐよりも車幅方向へオフセットした位置を検出してもよい。
(Modification)
(1) In the steering assist device 1 of the present embodiment, the target passage
（２）本実施形態の操舵支援装置１では、目標通過位置検出部６が、予め設定した第一所定時間間隔で目標通過位置を検出する。これに加え、操舵支援トルク算出部２６が、予め設定した第二所定時間間隔で操舵支援トルクを算出する。しかしながら、目標通過位置検出部６の構成は、これに限定するものではなく、目標通過位置検出部６及び操舵支援トルク算出部２６のうち少なくとも一方が、自車両Ｃの走行中において、連続して処理を行ってもよい。
(2) In the steering assist device 1 of the present embodiment, the target passage
（３）本実施形態の操舵支援装置１では、目標通過位置検出部６が、自車両Ｃを中心とする予め設定した所定半径Ｄの範囲内で、目標通過位置を検出するが、目標通過位置検出部６の構成は、これに限定するものではない。すなわち、目標通過位置検出部６の構成を、所定半径Ｄを設定せずに目標通過位置を検出する構成としてもよい。
(3) In the steering assist device 1 according to the present embodiment, the target passing
（４）本実施形態の操舵支援装置１では、操舵支援トルク減衰回路３０が、操舵角速度センサ２８が検出した操舵角速度θ’に応じて、トルク指令値Ｔｏの減衰度合いが変化するように、減衰指令信号を算出したが、これに限定するものではない。すなわち、トルク指令値Ｔｏを操舵支援トルクとして用いてもよい。この場合、操舵支援装置１の構成を、操舵角速度センサ２８及び操舵支援トルク減衰回路３０を備えていない構成としてもよい。
(4) In the steering assist device 1 of the present embodiment, as the steering assist
（５）本実施形態の操舵支援装置１では、走行路検出部２及び障害部検出部４を、自車両の周囲環境を画像として取得可能なＣＣＤカメラ等を有して形成したが、走行路検出部２及び障害部検出部４の構成は、これに限定するものではない。
すなわち、例えば、操舵支援装置１の構成を、自車両Ｃの車両前後方向の前面に配置して、自車両Ｃの車両前後方向前方に対してレーザーを照射するレーザーセンサを備えた構成とする。そして、レーザーセンサにより、レーザーの照射と、レーザーの照射後に走行経路上の障害物等により反射されたレーザーの受信を行い、レーザーを照射及び受信した時間により、走行路や障害物を検出可能な構成としてもよい。
(5) In the steering assist device 1 of the present embodiment, the travel path detection unit 2 and the obstacle unit detection unit 4 are formed with a CCD camera or the like that can acquire the surrounding environment of the host vehicle as an image. The structure of the detection part 2 and the fault part detection part 4 is not limited to this.
That is, for example, the configuration of the steering assist device 1 is configured to include a laser sensor that is disposed in front of the host vehicle C in the vehicle front-rear direction and irradiates a laser to the front of the host vehicle C in the vehicle front-rear direction. The laser sensor can receive the laser beam and receive the laser beam reflected by obstacles on the travel route after the laser irradiation. The travel route and obstacles can be detected based on the laser irradiation time. It is good also as a structure.
（６）本実施形態の操舵支援装置１では、自車両Ｃの走行中において、運転者が操舵支援装置１を作動させるスイッチを操作することにより、操舵支援装置１を作動させたが、これに限定するものではない。すなわち、例えば、自車両Ｃの周囲環境を撮像した画像を参照して、自車両が走行する道路（走行路）が、操舵支援装置１を作動させることが好ましい道路であるか否かを判定し、運転者の操作に因らず、操舵支援装置１を作動させてもよい。この場合、自車両Ｃの周囲環境を撮像した画像は、例えば、走行路検出部２が有するＣＣＤカメラ等を用いて取得する。 (6) In the steering assist device 1 of the present embodiment, the driver operates the steering assist device 1 by operating a switch that operates the steering assist device 1 while the host vehicle C is traveling. It is not limited. That is, for example, with reference to an image obtained by imaging the surrounding environment of the host vehicle C, it is determined whether or not the road (running path) on which the host vehicle travels is a road on which the steering assist device 1 is preferably operated. The steering assist device 1 may be operated regardless of the driver's operation. In this case, an image obtained by imaging the surrounding environment of the host vehicle C is acquired using, for example, a CCD camera included in the traveling path detection unit 2.
（７）本実施形態の操舵支援装置１では、第一所定時間間隔と第二所定時間間隔を、同じ値（１００［ｍｓｅｃ］）に設定したが、これに限定するものではなく、第一所定時間間隔と第二所定時間間隔を、異なる値に設定してもよい。この場合、例えば、第一所定時間間隔を１００［ｍｓｅｃ］と設定し、第二所定時間間隔を５０［ｍｓｅｃ］と設定する。 (7) In the steering assist device 1 of the present embodiment, the first predetermined time interval and the second predetermined time interval are set to the same value (100 [msec]), but the present invention is not limited to this. The time interval and the second predetermined time interval may be set to different values. In this case, for example, the first predetermined time interval is set to 100 [msec], and the second predetermined time interval is set to 50 [msec].
１ 操舵支援装置
２ 走行路検出部
４ 障害部検出部
６ 目標通過位置検出部
８ 自車姿勢角検出部
１０ 自車位置検出部
１２ 道路曲率検出部
１４ ヨーレート検出部
１６ 誘導状態算出部
１８ 誘導経路生成部
２０ 操舵角センサ
２２ 目標操舵角算出部
２４ 操舵角偏差算出部
２６ 操舵支援トルク算出部
２８ 操舵角速度センサ
３０ 操舵支援トルク減衰回路
３２ 操舵支援トルク出力部
Ｃ 自車両
Ｎ 最狭部
Ｐ 最狭部Ｎのうち、幅方向の中心位置
Ｂ 障害物
Ｄ 所定半径
DESCRIPTION OF SYMBOLS 1 Steering assistance apparatus 2 Traveling path detection part 4 Obstacle
Claims (5)
前記走行路検出部が検出した走行路において前記自車両が通過する目標位置である目標通過位置を検出する目標通過位置検出部と、
前記目標通過位置検出部が検出した目標通過位置へ到達するまでに前記自車両が目標とする姿勢角である誘導姿勢角を算出する誘導姿勢角算出部と、
前記目標通過位置検出部が検出した目標通過位置へ到達するまでに前記自車両が目標とする横位置である誘導横位置を算出する誘導横位置算出部と、
前記自車両の現在の姿勢角を検出する現在姿勢角検出部と、
前記自車両の現在の横位置を検出する現在横位置検出部と、
前記自車両の現在のヨーレートを検出するヨーレート検出部と、
前記誘導姿勢角算出部が算出した誘導姿勢角、前記誘導横位置算出部が算出した誘導横位置、前記現在姿勢角検出部が検出した姿勢角、前記現在横位置検出部が検出した横位置及び前記ヨーレート検出部が検出したヨーレートに基づき、前記走行路検出部が検出した走行路において前記自車両が走行すべき経路である誘導経路を生成する誘導経路生成部と、
前記誘導経路生成部が生成した誘導経路を前記自車両が走行するために操舵輪の目標とする回転角度である目標操舵角を算出する目標操舵角算出部と、
前記操舵輪の現在の回転角度である現在操舵角を検出する現在操舵角検出部と、
前記目標操舵角算出部が算出した目標操舵角と前記現在操舵角検出部が検出した現在操舵角との差分である操舵角偏差を算出する操舵角偏差算出部と、
前記操舵角偏差算出部が算出した操舵角偏差を縮小させるための操舵支援トルクを算出する操舵支援トルク算出部と、
前記操舵支援トルク算出部が算出した操舵支援トルクを前記操舵輪へ出力する操舵支援トルク出力部と、を備えることを特徴とする車両の操舵支援装置。 A travel path detection unit that detects a travel path on which the host vehicle travels;
A target passage position detector that detects a target passage position that is a target position through which the host vehicle passes on the road detected by the road detector;
A guidance posture angle calculation unit that calculates a guidance posture angle that is a target posture angle of the host vehicle before reaching the target passage position detected by the target passage position detection unit;
A guided lateral position calculating unit that calculates a guided lateral position that is a lateral position targeted by the host vehicle before reaching the target passing position detected by the target passing position detecting unit;
A current posture angle detection unit for detecting a current posture angle of the host vehicle;
A current lateral position detection unit for detecting a current lateral position of the host vehicle;
A yaw rate detector for detecting the current yaw rate of the host vehicle;
The guided posture angle calculated by the guided posture angle calculating unit, the guided lateral position calculated by the guided lateral position calculating unit, the posture angle detected by the current posture angle detecting unit, the lateral position detected by the current lateral position detecting unit, and Based on the yaw rate detected by the yaw rate detection unit, a guidance route generation unit that generates a guidance route that is a route on which the host vehicle should travel on the travel route detected by the travel route detection unit;
A target steering angle calculation unit that calculates a target steering angle that is a target rotation angle of a steering wheel in order for the host vehicle to travel along the guidance route generated by the guidance route generation unit;
A current steering angle detection unit that detects a current steering angle that is a current rotation angle of the steering wheel;
A steering angle deviation calculation unit that calculates a steering angle deviation that is a difference between the target steering angle calculated by the target steering angle calculation unit and the current steering angle detected by the current steering angle detection unit;
A steering assist torque calculator for calculating a steering assist torque for reducing the steering angle deviation calculated by the steering angle deviation calculator;
A steering assistance device for a vehicle, comprising: a steering assistance torque output unit that outputs the steering assistance torque calculated by the steering assistance torque calculation unit to the steered wheels.
前記操舵支援トルク算出部は、予め設定した第二所定時間間隔で前記操舵支援トルクを算出することを特徴とする請求項１から請求項３のうちいずれか１項に記載した車両の操舵支援装置。 The target passing position detection unit detects the target passing position at a preset first predetermined time interval,
The steering assist device for a vehicle according to any one of claims 1 to 3, wherein the steering assist torque calculation unit calculates the steering assist torque at a preset second predetermined time interval. .
前記目標通過位置検出ステップで検出した目標通過位置へ到達するまでに前記自車両が目標とする姿勢角である誘導姿勢角を算出する誘導姿勢角算出ステップと、
前記目標通過位置検出ステップで検出した目標通過位置へ到達するまでに前記自車両が目標とする横位置である誘導横位置を算出する誘導横位置算出ステップと、
前記誘導姿勢角算出ステップで算出した誘導姿勢角、前記誘導横位置算出ステップで算出した誘導横位置、前記自車両の現在の姿勢角、前記自車両の現在の横位置、前記自車両の現在のヨーレートに基づき、前記走行路において前記自車両が走行すべき経路である誘導経路を生成する誘導経路生成ステップと、
前記誘導経路生成ステップで生成した誘導経路を前記自車両が走行するために操舵輪の目標とする回転角度である目標操舵角を算出する目標操舵角算出ステップと、
前記目標操舵角算出ステップで算出した目標操舵角と前記操舵輪の現在の回転角度である現在操舵角との差分である操舵角偏差を算出する操舵角偏差算出ステップと、
前記操舵角偏差算出ステップが算出した操舵角偏差を縮小させるための操舵支援トルクを算出する操舵支援トルク算出ステップと、
前記操舵支援トルク算出ステップが算出した操舵支援トルクを前記操舵輪へ出力する操舵支援トルク出力ステップと、を有することを特徴とする車両の操舵支援方法。 A target passing position detecting step for detecting a target passing position that is a target position through which the host vehicle passes on a travel path on which the host vehicle travels;
A guided attitude angle calculating step of calculating a guided attitude angle that is a target attitude angle of the host vehicle until reaching the target passing position detected in the target passing position detecting step;
A guided lateral position calculating step for calculating a guided lateral position that is a lateral position targeted by the host vehicle before reaching the target passing position detected in the target passing position detecting step;
The guidance attitude angle calculated in the guidance attitude angle calculation step, the guidance lateral position calculated in the guidance lateral position calculation step, the current attitude angle of the host vehicle, the current lateral position of the host vehicle, the current position of the host vehicle Based on the yaw rate, a guidance route generation step for generating a guidance route that is a route on which the host vehicle should travel on the travel route;
A target steering angle calculating step for calculating a target steering angle, which is a target rotation angle of the steered wheels in order for the host vehicle to travel along the guidance route generated in the guidance route generation step;
A steering angle deviation calculating step for calculating a steering angle deviation that is a difference between the target steering angle calculated in the target steering angle calculating step and a current steering angle that is a current rotation angle of the steering wheel;
A steering assist torque calculating step for calculating a steering assist torque for reducing the steering angle deviation calculated by the steering angle deviation calculating step;
A steering assistance torque output step of outputting the steering assistance torque calculated in the steering assistance torque calculation step to the steered wheels.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2011194855A JP5799688B2 (en) | 2011-09-07 | 2011-09-07 | Steering support apparatus and steering support method for vehicle |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2011194855A JP5799688B2 (en) | 2011-09-07 | 2011-09-07 | Steering support apparatus and steering support method for vehicle |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2013056576A true JP2013056576A (en) | 2013-03-28 |
| JP5799688B2 JP5799688B2 (en) | 2015-10-28 |
Family
ID=48132863
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2011194855A Active JP5799688B2 (en) | 2011-09-07 | 2011-09-07 | Steering support apparatus and steering support method for vehicle |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5799688B2 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20230066968A (en) * | 2021-11-08 | 2023-05-16 | (주)컨트롤웍스 | Apparatus and method for controlling steering angle of autonomous driving industrial vehicles |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06298108A (en) * | 1993-04-12 | 1994-10-25 | Aisin Seiki Co Ltd | Automatic steering device for vehicle |
| JP2004199286A (en) * | 2002-12-17 | 2004-07-15 | Fuji Heavy Ind Ltd | Travel controller for vehicle |
| JP2006031553A (en) * | 2004-07-20 | 2006-02-02 | Aisin Seiki Co Ltd | Lane traveling support device for vehicle |
| WO2010038317A1 (en) * | 2008-09-30 | 2010-04-08 | Nissan Motor Co., Ltd. | System provided with an assistance-controller for assisting an operator of the system, control-operation assisting device, control-operation assisting method, driving-operation assisting device, and driving-operation assisting method |
-
2011
- 2011-09-07 JP JP2011194855A patent/JP5799688B2/en active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06298108A (en) * | 1993-04-12 | 1994-10-25 | Aisin Seiki Co Ltd | Automatic steering device for vehicle |
| JP2004199286A (en) * | 2002-12-17 | 2004-07-15 | Fuji Heavy Ind Ltd | Travel controller for vehicle |
| JP2006031553A (en) * | 2004-07-20 | 2006-02-02 | Aisin Seiki Co Ltd | Lane traveling support device for vehicle |
| WO2010038317A1 (en) * | 2008-09-30 | 2010-04-08 | Nissan Motor Co., Ltd. | System provided with an assistance-controller for assisting an operator of the system, control-operation assisting device, control-operation assisting method, driving-operation assisting device, and driving-operation assisting method |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20230066968A (en) * | 2021-11-08 | 2023-05-16 | (주)컨트롤웍스 | Apparatus and method for controlling steering angle of autonomous driving industrial vehicles |
| KR102649443B1 (en) * | 2021-11-08 | 2024-03-21 | 주식회사 에이스웍스코리아 | Apparatus and method for controlling steering angle of autonomous driving industrial vehicles |
Also Published As
| Publication number | Publication date |
|---|---|
| JP5799688B2 (en) | 2015-10-28 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5765431B2 (en) | Vehicle driving support system | |
| US10414438B2 (en) | Parking assistance device and parking assistance method | |
| KR101398223B1 (en) | Control apparatus of vehicle for changing lane and Control method of the same | |
| JP5761360B2 (en) | Vehicle driving support system | |
| CN103183028B (en) | Lane-keeping assistance method for a motor vehicle | |
| JP6344275B2 (en) | Vehicle control device | |
| JP6269534B2 (en) | Travel control device | |
| KR101503418B1 (en) | Semiautomatic parking machine | |
| JP6747597B2 (en) | Driving control method and driving control device for driving assistance vehicle | |
| US9911330B2 (en) | Driving assistance device and driving assistance method | |
| JP3917241B2 (en) | Vehicle driving support device | |
| JP4531621B2 (en) | Vehicle travel safety device | |
| JP5899664B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
| JP2007253745A (en) | Avoidance operation calculating device, avoidance controller, vehicle provided with each device, avoidance operation calculating method, and avoidance control method | |
| JP2017526064A (en) | Method for driving a vehicle at least semi-autonomously, driver assistance system and vehicle | |
| JP2006298008A (en) | Operation supporting device of vehicle | |
| JPWO2017077807A1 (en) | Vehicle travel control device | |
| JP5978709B2 (en) | Parking assistance device | |
| JP2018203108A (en) | Vehicle control device | |
| JP2017144759A (en) | Vehicle control device | |
| US20210061350A1 (en) | Driving support device | |
| JP6512004B2 (en) | Parking support device and parking support method | |
| JP4999762B2 (en) | Vehicle contact avoidance support device | |
| JP7243227B2 (en) | vehicle controller | |
| JP5799688B2 (en) | Steering support apparatus and steering support method for vehicle |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20140724 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20150410 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20150512 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150709 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20150728 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20150810 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 5799688 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |