JP2005280402A - Motion control device for vehicle - Google Patents
Motion control device for vehicle Download PDFInfo
- Publication number
- JP2005280402A JP2005280402A JP2004094159A JP2004094159A JP2005280402A JP 2005280402 A JP2005280402 A JP 2005280402A JP 2004094159 A JP2004094159 A JP 2004094159A JP 2004094159 A JP2004094159 A JP 2004094159A JP 2005280402 A JP2005280402 A JP 2005280402A
- Authority
- JP
- Japan
- Prior art keywords
- motion parameter
- reference target
- vehicle
- corner radius
- target motion
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Regulating Braking Force (AREA)
- Traffic Control Systems (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
Description
本発明は、ヨーレート検出手段で検出されるヨーレートを目標ヨーレートに近づける旋回制御を可能とした車両の運動制御装置に関する。 The present invention relates to a vehicle motion control apparatus that enables turn control to bring a yaw rate detected by a yaw rate detection means closer to a target yaw rate.
従来、実際に検出されたヨーレートが舵角に基づく目標ヨーレートに近づくように旋回制御するようにした車両の運動制御装置がたとえば特許文献1等で知られている。
ところが、舵角に基づいてヨーレートを目標ヨーレートに近づけるように制御するようにした従来の運動制御装置では、目標ヨーレートを舵角に基づいて定めるものであるので、コーナー通過時には実際の道路形状とは合わない操舵をすることが考えられ、この場合、ヨーレートをコントロールする制御が遅れたり、あるいは過剰に制御してしまうことがある。 However, in the conventional motion control device that controls the yaw rate to approach the target yaw rate based on the rudder angle, the target yaw rate is determined based on the rudder angle. It is conceivable to perform steering that does not match, and in this case, control for controlling the yaw rate may be delayed or excessively controlled.
そこで、ナビゲーションシステムで得られる情報からコーナーの半径を求め、その半径に基づいて定めた目標ヨーレートに実際のヨーレートを近づけるように制御して、上述の問題を解消することが考えられる。ところが山道、トンネルおよびビル街等の走行に伴うGPS信号の受信不良や、CDおよびDVDの不良、機械の故障および悪路走行等による道路データの読出し不良に起因して道路情報が得られない場合があり、そのような場合には、目標ヨーレートを定めることが困難となってしまう。 Therefore, it is conceivable to solve the above-mentioned problem by obtaining the corner radius from the information obtained by the navigation system and controlling the actual yaw rate to be close to the target yaw rate determined based on the radius. However, when road information cannot be obtained due to poor GPS signal reception due to traveling on mountain roads, tunnels, building streets, etc., or CD and DVD defects, mechanical failure, bad road driving, etc. In such a case, it is difficult to determine the target yaw rate.
本発明は、かかる事情に鑑みてなされたものであり、コーナー走行時に制御の遅れや過剰制御が生じることを極力回避しつつ、道路情報が得られない場合にも適切な操縦安定制御を可能とした車両の運動制御装置を提供することを目的とする。 The present invention has been made in view of such circumstances, and it is possible to perform appropriate steering stability control even when road information cannot be obtained while avoiding as much as possible control delay and excessive control during corner traveling. An object of the present invention is to provide a motion control device for a vehicle.
上記目的を達成するために、請求項1記載の発明は、道路データを記憶する道路データ記憶手段と、前記道路データ上の自車位置を検出する自車位置検出手段と、車速を検出する車速検出手段と、前記道路データおよび前記自車位置に基づいて自車が現在走行している経路上に存在するコーナーの半径を検出するコーナー半径検出手段と、前記車速および前記コーナーの半径に基づいて自車の目標とする旋回運動状態を表すコーナー半径基準目標運動パラメータを決定するコーナー半径基準目標運動パラメータ決定手段と、自車の舵角を検出する舵角検出手段と、前記車速および前記舵角に基づいて自車の目標とする旋回運動状態を表す舵角基準目標運動パラメータを決定する舵角基準目標運動パラメータ決定手段と、自車の実際の旋回運動状態を表す実運動パラメータを検出する実運動パラメータ検出手段と、前記コーナー半径基準目標運動パラメータおよび前記実運動パラメータを比較する第1比較手段と、前記舵角基準目標運動パラメータおよび前記実運動パラメータを比較する第2比較手段と、作動時に自車の旋回運動状態を調整し得るアクチュエータと、前記第1および第2比較手段の比較結果に基づいて前記アクチュエータの作動を制御する制御手段とを備え、該制御手段は、前記コーナー半径基準目標運動パラメータおよび前記舵角基準目標運動パラメータのうち少なくとも前記コーナー半径基準目標運動パラメータが決定されている状態では前記第1比較手段の比較結果に基づいてアクチュエータを制御し、前記コーナー半径基準目標運動パラメータおよび前記舵角基準目標運動パラメータのうち前記舵角基準目標運動パラメータだけが決定されている状態では第2比較手段の比較結果に基づいてアクチュエータを制御することを特徴とする。
In order to achieve the above object, the invention described in
また請求項2記載の発明は、道路データを記憶する道路データ記憶手段と、前記道路データ上の自車位置を検出する自車位置検出手段と、車速を検出する車速検出手段と、前記道路データおよび前記自車位置に基づいて自車が現在走行している経路上に存在するコーナーの半径を検出するコーナー半径検出手段と、前記車速および前記コーナーの半径に基づいて自車の目標とする旋回運動状態を表すコーナー半径基準目標運動パラメータを決定するコーナー半径基準目標運動パラメータ決定手段と、自車の舵角を検出する舵角検出手段と、前記車速および前記舵角に基づいて自車の目標とする旋回運動状態を表す舵角基準目標運動パラメータを決定する舵角基準目標運動パラメータ決定手段と、自車の実際の旋回運動状態を表す実運動パラメータを検出する実運動パラメータ検出手段と、前記コーナー半径基準目標運動パラメータおよび前記実運動パラメータを比較する比較手段と、作動時に自車の旋回運動状態を調整し得るアクチュエータと、前記比較手段の比較結果に基づいて前記アクチュエータの作動を制御する制御手段とを備え、前記比較手段は、前記コーナー半径基準目標運動パラメータ決定手段が前記コーナー半径基準目標運動パラメータを決定不能な状態では前記舵角基準目標運動パラメータおよび前記実運動パラメータを比較することを特徴とする。 According to a second aspect of the present invention, there is provided road data storing means for storing road data, own vehicle position detecting means for detecting the own vehicle position on the road data, vehicle speed detecting means for detecting a vehicle speed, and the road data. And corner radius detecting means for detecting a radius of a corner existing on a route on which the host vehicle is currently traveling based on the host vehicle position, and a turning target of the host vehicle based on the vehicle speed and the corner radius. Corner radius reference target motion parameter determination means for determining a corner radius reference target motion parameter representing a motion state, steering angle detection means for detecting the steering angle of the host vehicle, and the target of the host vehicle based on the vehicle speed and the steering angle Rudder angle reference target motion parameter determination means for determining the rudder angle reference target motion parameter representing the turning motion state and the actual motion parameter representing the actual turning motion state of the host vehicle. A comparison of the actual motion parameter detecting means for detecting the motor, a comparison means for comparing the corner radius reference target motion parameter and the actual motion parameter, an actuator capable of adjusting the turning motion state of the own vehicle during operation, and the comparison means Control means for controlling the operation of the actuator based on the result, and the comparing means is the rudder angle reference target when the corner radius reference target motion parameter determination means cannot determine the corner radius reference target motion parameter. The motion parameter is compared with the actual motion parameter.
請求項3記載の発明は、請求項1または2記載の発明の構成に加えて、前記制御手段は、前記舵角基準目標運動パラメータおよび前記実運動パラメータの比較結果に基づいてアクチュエータの制御を実行する際には、前記コーナー半径基準目標運動パラメータおよび前記実運動パラメータの比較結果とは無関係に、前記舵角基準目標運動パラメータおよび前記実運動パラメータの比較結果に基づいてアクチュエータの制御を終了まで継続することを特徴とする。 According to a third aspect of the invention, in addition to the configuration of the first or second aspect of the invention, the control means executes control of the actuator based on a comparison result between the steering angle reference target motion parameter and the actual motion parameter. When controlling the actuator, the control of the actuator is continued until the end based on the comparison result of the steering angle reference target motion parameter and the actual motion parameter regardless of the comparison result of the corner radius reference target motion parameter and the actual motion parameter. It is characterized by doing.
請求項4記載の発明は、道路データを記憶する道路データ記憶手段と、前記道路データ上の自車位置を検出する自車位置検出手段と、車速を検出する車速検出手段と、前記道路データおよび前記自車位置に基づいて自車が現在走行している経路上に存在するコーナーの半径を検出するコーナー半径検出手段と、前記車速および前記コーナーの半径に基づいて自車の目標とする旋回運動状態を表すコーナー半径基準目標運動パラメータを決定するコーナー半径基準目標運動パラメータ決定手段と、自車の舵角を検出する舵角検出手段と、前記車速および前記舵角に基づいて自車の目標とする旋回運動状態を表す舵角基準目標運動パラメータを決定する舵角基準目標運動パラメータ決定手段と、自車の実際の旋回運動状態を表す実運動パラメータを検出する実運動パラメータ検出手段と、前記コーナー半径基準目標運動パラメータおよび前記実運動パラメータを比較する第1比較手段と、前記舵角基準目標運動パラメータおよび前記実運動パラメータを比較する第2比較手段と、作動時に自車の旋回運動状態を調整し得るアクチュエータと、前記第1および第2比較手段の比較結果に基づいて定まる制御量のうち大きな制御量となる側を選択して前記アクチュエータの作動を制御するとともに前記第2比較手段の比較結果に基づくアクチュエータの制御を実行中には第1比較手段の比較結果とは無関係にその制御終了まで第2比較手段の比較結果に基づく制御を続行する制御手段とを備えることを特徴とする。 According to a fourth aspect of the present invention, road data storage means for storing road data, own vehicle position detection means for detecting the own vehicle position on the road data, vehicle speed detection means for detecting a vehicle speed, the road data and Corner radius detection means for detecting a radius of a corner existing on a route on which the host vehicle is currently traveling based on the host vehicle position, and a turning motion targeted by the host vehicle based on the vehicle speed and the corner radius A corner radius reference target motion parameter determining means for determining a corner radius reference target motion parameter representing a state, a steering angle detection means for detecting a steering angle of the host vehicle, a target of the host vehicle based on the vehicle speed and the steering angle, and Rudder angle reference target motion parameter determination means for determining a rudder angle reference target motion parameter representing a turning motion state to be performed, and an actual motion parameter representing an actual turning motion state of the host vehicle Real motion parameter detection means for detecting; first comparison means for comparing the corner radius reference target motion parameter and the actual motion parameter; and second comparison means for comparing the steering angle reference target motion parameter and the actual motion parameter. The actuator that can adjust the turning motion state of the own vehicle at the time of operation and the control amount determined based on the comparison results of the first and second comparison means are selected to operate the actuator. Control that continues the control based on the comparison result of the second comparison means until the end of the control regardless of the comparison result of the first comparison means during the control of the actuator based on the comparison result of the second comparison means. Means.
さらに請求項5記載の発明は、請求項1〜4のいずれかに記載の発明の構成に加えて、前記コーナー半径基準目標運動パラメータおよび前記舵角基準目標運動パラメータの偏差に基づいて前記舵角舵角基準目標運動パラメータを補正する補正手段を含むことを特徴とする。
Further, the invention according to
請求項1記載の発明によれば、車速およびコーナーの半径に基づくコーナー基準目標運動パラメータが得られるときには、そのコーナー基準目標運動パラメータに実運動パラメータが近づくようにアクチュエータを制御するので、コーナー通過時の制御が遅れたり、過剰制御が生じたりすることを極力回避することができ、また道路情報が得られない場合には、車速および舵角に基づく舵角基準目標運動パラメータに実運動パラメータが近づくようにアクチュエータを制御するので、適切な操縦安定制御を継続して実行することができる。 According to the first aspect of the present invention, when the corner reference target motion parameter based on the vehicle speed and the corner radius is obtained, the actuator is controlled so that the actual motion parameter approaches the corner reference target motion parameter. The actual motion parameter approaches the rudder angle reference target motion parameter based on the vehicle speed and the rudder angle when road information cannot be obtained. Thus, the appropriate steering stability control can be continuously executed.
また請求項2記載の発明によれば、比較手段は、車速およびコーナーの半径に基づくコーナー基準目標運動パラメータが得られるときには、そのコーナー基準目標運動パラメータおよび実運動パラメータを比較し、コーナー基準目標運動パラメータが得られないときには、車速および舵角に基づく舵角基準目標運動パラメータおよび前記実運動パラメータを比較するものであり、コーナー通過時の制御が遅れたり、過剰制御が生じたりすることを極力回避することができ、また道路情報が得られない場合には、舵角基準目標運動パラメータに実運動パラメータが近づくようにアクチュエータを制御するので、適切な操縦安定制御を継続して実行することができる。 According to the second aspect of the present invention, when the corner reference target motion parameter based on the vehicle speed and the corner radius is obtained, the comparison means compares the corner reference target motion parameter and the actual motion parameter, and calculates the corner reference target motion. When the parameter cannot be obtained, the rudder angle reference target motion parameter based on the vehicle speed and the rudder angle and the actual motion parameter are compared, and it is avoided as much as possible that control at the time of passing the corner is delayed or excessive control occurs. If the road information cannot be obtained, the actuator is controlled so that the actual motion parameter approaches the rudder angle reference target motion parameter, so that appropriate steering stability control can be continuously executed. .
請求項3記載の発明によれば、舵角基準目標運動パラメータおよび実運動パラメータの比較結果に基づくアクチュエータの制御に入ったときには、コーナー半径基準目標運動パラメータが得られるようになっても、制御手段がその制御を終了するまで継続して実行するので、制御の途中で舵角基準目標運動パラメータおよびコーナー基準目標運動パラメータに基づく制御が頻繁に切り換わったり、制御の干渉が生じるのを防止することができるとともに、車両運転者の操縦意志を尊重した制御を行うことができる。 According to the third aspect of the present invention, when the control of the actuator based on the comparison result of the rudder angle reference target motion parameter and the actual motion parameter is entered, the control means is provided even if the corner radius reference target motion parameter can be obtained. Will continue to be executed until the control is finished, so that control based on the rudder angle reference target motion parameter and the corner reference target motion parameter during the control will not be frequently switched, and control interference will not occur. In addition, it is possible to perform control that respects the driving intention of the vehicle driver.
請求項4記載の発明によれば、車速およびコーナーの半径に基づくコーナー基準目標運動パラメータおよび実運動パラメータの比較に基づく制御、ならびに車速および舵角に基づく舵角基準目標運動パラメータおよび実運動パラメータの比較に基づく制御のうち、制御量が大きくなるほうを選択してアクチュエータを制御するようにしているので、コーナー通過時の制御が遅れたり、過剰制御が生じたりすることを極力回避するとともに、道路情報が得られない場合にも、車両運転者の操舵意志により適合した操縦安定制御を実行することが可能であり、しかも舵角基準目標運動パラメータおよび実運動パラメータの比較結果に基づくアクチュエータの制御に入ったときには、制御手段がその制御を終了するまで継続して実行するので、制御の途中で舵角基準目標運動パラメータおよびコーナー基準目標運動パラメータに基づく制御制御が頻繁に切り換わったり、制御の干渉が生じるのを防止することができるとともに、車両運転者の操縦意志を尊重した制御を行うことができる。 According to the fourth aspect of the present invention, the control based on the comparison between the corner reference target motion parameter and the actual motion parameter based on the vehicle speed and the corner radius, and the steering angle reference target motion parameter and the actual motion parameter based on the vehicle speed and the steering angle. Of the controls based on the comparison, the actuator with the larger control amount is selected to control the actuator, so that the control at the time of passing the corner is delayed and excessive control is avoided as much as possible. Even when information is not available, it is possible to execute steering stability control that is more suitable for the vehicle driver's steering intention, and to control the actuator based on the comparison result of the steering angle reference target motion parameter and the actual motion parameter. When entering, control means will continue to run until it finishes its control, so control Controls based on the steering angle reference target motion parameters and corner reference target motion parameters can be prevented from being frequently switched and control interference can be prevented, and control that respects the vehicle driver's willingness to control It can be carried out.
さらに請求項5記載の発明によれば、コーナー基準目標運動パラメータおよび実運動パラメータの比較に基づく制御、ならびに舵角基準目標運動パラメータおよび実運動パラメータの比較に基づく制御の切換時に、制御量が大きく変化することを回避し、車両運転者が違和感を感じることがないようにして制御の切換えを滑らかにすることができる。 According to the fifth aspect of the present invention, the control amount is large when switching between the control based on the comparison between the corner reference target motion parameter and the actual motion parameter and the control based on the comparison between the steering angle reference target motion parameter and the actual motion parameter. It is possible to avoid the change and to smoothly switch the control so that the vehicle driver does not feel uncomfortable.
以下、本発明の実施の形態を、添付の図面に示した本発明の実施例に基づいて説明する。 DESCRIPTION OF THE PREFERRED EMBODIMENTS Embodiments of the present invention will be described below based on examples of the present invention shown in the accompanying drawings.
図1〜図3は本発明の第1実施例を示すものであり、図1は運動制御装置の構成を示すブロック図、図2は道路データの一例を示す図、図3はコーナー半径基準目標ヨーレートおよび舵角基準目標ヨーレートを対比して示す図である。 1 to 3 show a first embodiment of the present invention, FIG. 1 is a block diagram showing the configuration of a motion control device, FIG. 2 is a diagram showing an example of road data, and FIG. 3 is a corner radius reference target. It is a figure which compares and shows a yaw rate and a steering angle reference | standard target yaw rate.
先ず図1において、車両の運動制御装置は、道路データを記憶する道路データ記憶手段1と、前記道路データ上での自車位置を検出する自車位置検出手段2と、自車の車速Vを検出する車速検出手段3と、前記道路データおよび前記自車位置に基づいて自車が現在走行している経路上に存在するコーナーの半径Rを求めるコーナー半径検出手段4と、前記車速Vおよび前記コーナーの半径Rに基づいて自車の目標とする旋回運動状態を表すコーナー半径基準目標運動パラメータを決定するコーナー半径基準目標運動パラメータ決定手段5と、自車の舵角αを検出する舵角検出手段6と、前記車速Vおよび前記舵角αに基づいて自車の目標とする旋回運動状態を表す舵角基準目標運動パラメータを決定する舵角基準目標運動パラメータ決定手段7と、自車の実際の旋回運動状態を表す実運動パラメータを検出する実運動パラメータ検出手段8と、前記コーナー半径基準目標運動パラメータおよび前記実運動パラメータを比較する第1比較手段9と、前記舵角基準目標運動パラメータを補正する補正手段10と、補正後の舵角基準目標運動パラメータおよび前記実運動パラメータを比較する第2比較手段11と、作動時に自車の旋回運動状態を調整し得るアクチュエータ12と、第1および第2比較手段9,11の比較結果に基づいて前記アクチュエータ12の作動を制御する制御手段13とを備える。
First, in FIG. 1, a vehicle motion control device includes road data storage means 1 for storing road data, own vehicle position detection means 2 for detecting the own vehicle position on the road data, and vehicle speed V of the own vehicle. Vehicle speed detecting means 3 for detecting, corner radius detecting means 4 for determining a radius R of a corner existing on the route on which the vehicle is currently traveling based on the road data and the vehicle position, the vehicle speed V and the vehicle A corner radius reference target motion parameter determining means 5 for determining a corner radius reference target motion parameter representing a turning motion state targeted by the host vehicle based on the corner radius R, and a steering angle detection for detecting the steering angle α of the host vehicle.
自車の旋回運動状態を表す運動パラメータとしてはヨーレートが用いられ、コーナー半径基準目標運動パラメータ決定手段5ではコーナー半径基準目標ヨーレートγRが決定され、舵角基準目標運動パラメータ決定手段7では舵角基準目標ヨーレートγαが決定され、実運動パラメータ検出手段8により実ヨーレートγが検出される。 The yaw rate is used as a motion parameter representing the turning motion state of the host vehicle, the corner radius reference target motion parameter determination means 5 determines the corner radius reference target yaw rate γR, and the steering angle reference target motion parameter determination means 7 determines the steering angle reference. The target yaw rate γα is determined, and the actual yaw rate γ is detected by the actual motion parameter detection means 8.
前記道路データ記憶手段1および自車位置検出手段2は、ナビゲーションシステムNに含まれるものであり、道路データ記憶手段1には、図2で示すように、相互に間隔L0,L1…Lnをあけた複数のノード点N1,N2…Nn…から成る道路データが記憶されており、コーナー半径演算手段4は、少なくとも相互に隣接するノード点N1,N2…Nnの位置情報に基づく演算によって道路データ上の各ノード点N1,N2…Nnでの半径を得るとともに、各ノード点の半径を平均化することでコーナーの半径Rを算出する。 The road data storage means 1 and the vehicle position detection means 2 are included in the navigation system N, and the road data storage means 1 is spaced apart from each other as shown in FIG. Further, road data composed of a plurality of node points N1, N2,... Nn... Is stored, and the corner radius calculation means 4 performs the calculation based on the position information of at least adjacent node points N1, N2,. Are calculated at the respective node points N1, N2,... Nn, and the corner radius R is calculated by averaging the radii of the respective node points.
すなわち各ノード点N1,N2…Nnのリンク交差角をθ1,θ2…θn(ラジアン)、ノード点Nnの両側の間隔をL(n−1)、Lnとしたときに、ノード点Nnにおける半径Rnがコーナー半径演算手段4で次式に基づいて算出され、それらの半径Rnの平均値としてコーナーの半径Rが得られることになる。 That is, when the link intersection angles of the node points N1, N2... Nn are θ1, θ2... Θn (radians) and the distances between both sides of the node point Nn are L (n−1) and Ln, the radius Rn at the node point Nn. Is calculated by the corner radius calculation means 4 based on the following formula, and the corner radius R is obtained as an average value of the radii Rn.
Rn=〔{L(n−1)/θn}+{Ln/θn}〕/2 ={L(n−1)+Ln}/2θn
コーナー半径基準目標運動パラメータ決定手段5は、車速検出手段3で検出した自車の車速Vと、コーナー半径検出手段4で得られた半径Rとに基づいて、コーナー半径基準目標ヨーレートγRを決定し、第1比較手段9では、コーナー半径基準目標ヨーレートγRと、実運動パラメータ検出手段8で検出された実ヨーレートγとが比較され、その比較結果が制御手段13に入力される。
Rn = [{L (n−1) / θn} + {Ln / θn}] / 2 = {L (n−1) + Ln} / 2θn
The corner radius reference target motion parameter determination means 5 determines the corner radius reference target yaw rate γR based on the vehicle speed V of the host vehicle detected by the vehicle speed detection means 3 and the radius R obtained by the corner radius detection means 4. The first comparison means 9 compares the corner radius reference target yaw rate γR with the actual yaw rate γ detected by the actual motion parameter detection means 8, and the comparison result is input to the control means 13.
また舵角基準目標運動パラメータ決定手段7は、車速検出手段3で検出した自車の車速Vと、舵角検出手段6で検出した舵角αとに基づいて、舵角基準目標ヨーレートγαを決定する。 The steering angle reference target motion parameter determination means 7 determines a steering angle reference target yaw rate γα based on the vehicle speed V detected by the vehicle speed detection means 3 and the steering angle α detected by the steering angle detection means 6. To do.
補正手段10は、コーナー半径基準目標運動パラメータ決定手段5で決定されたコーナー半径基準目標ヨーレートγRと、前記舵角基準目標運動パラメータ決定手段7で決定された舵角基準目標ヨーレートγαとの偏差に基づいて舵角基準目標ヨーレートγαを補正する。 The correction means 10 determines the deviation between the corner radius reference target yaw rate γR determined by the corner radius reference target motion parameter determination means 5 and the steering angle reference target yaw rate γα determined by the steering angle reference target motion parameter determination means 7. Based on this, the steering angle reference target yaw rate γα is corrected.
すなわちコーナー半径基準目標ヨーレートγRおよび舵角基準目標ヨーレートγαは、図3で示すように、その値の大きさおよび位相が相互に異なるものであり、補正手段10は、前記偏差に基づいてゲイン補正量aおよび位相補正量bを常時推定するとともに移動平均等でそれらの補正量a,bを安定化しておき、舵角基準目標ヨーレートγαを(a×γα+b)として持ち替えるようにして補正する。 That is, as shown in FIG. 3, the corner radius reference target yaw rate γR and the steering angle reference target yaw rate γα have mutually different magnitudes and phases, and the correction means 10 performs gain correction based on the deviation. The amount a and the phase correction amount b are always estimated and the correction amounts a and b are stabilized by a moving average or the like, and the steering angle reference target yaw rate γα is changed as (a × γα + b) and corrected.
ここで、コーナー半径基準目標ヨーレートγRの最大値および最小値をγRmax、γRminとし、舵角基準目標ヨーレートγαの最大値および最小値をγαmax、γαminとしたときに、 a=(γRmax−γRmin)/(γαmax−γαmin) b=(γRmax−γRmin)/2−(γαmax−γαmin)/2 である。 Here, when the maximum and minimum values of the corner radius reference target yaw rate γR are γRmax and γRmin, and the maximum and minimum values of the steering angle reference target yaw rate γα are γαmax and γαmin, a = (γRmax−γRmin) / (Γαmax−γαmin) b = (γRmax−γRmin) / 2− (γαmax−γαmin) / 2
而して第2比較手段11では、補正手段10で補正された後の舵角基準目標ヨーレートγα′と、運動パラメータ検出手段8で検出された実ヨーレートγとが比較され、その比較結果が制御手段13に入力される。 Thus, the second comparison means 11 compares the steering angle reference target yaw rate γα ′ corrected by the correction means 10 with the actual yaw rate γ detected by the motion parameter detection means 8, and the comparison result is controlled. Input to means 13.
制御手段13は、第1および第2比較手段9,11の比較結果に基づいてアクチュエータ12の作動を制御するのであるが、コーナー半径基準目標ヨーレートγRおよび舵角基準目標ヨーレートγαのうち少なくともコーナー半径基準目標ヨーレートγRがコーナー半径基準目標運動パラメータ決定手段5で決定されている状態、すなわちナビゲーションシステムNが正常に機能している状態では、第1比較手段9の比較結果に基づいてアクチュエータ12を制御し、コーナー半径基準目標ヨーレートγRおよび舵角基準目標ヨーレートγαのうち舵角基準目標ヨーレートγαだけが得られる状態、すなわち山道、トンネルおよびビル街等の走行に伴うGPS信号の受信不良や、CDおよびDVDの不良、機械の故障および悪路走行等による道路データの読出し不良に起因してナビゲーションシステムNが不調である状態では、第2比較手段11の比較結果に基づいてアクチュエータ12を制御する。
The
しかも制御手段13は、第2比較手段11の比較結果に基づいてアクチュエータ12の制御を実行する際には、第1比較手段11の比較結果とは無関係に、第2比較手段11の比較結果に基づいてアクチュエータ12の制御を終了まで継続するものである。
In addition, when the
アクチュエータ12は、たとえば複数の車輪に個別に装着された車輪ブレーキのブレーキ力を個別に調整可能としたブレーキアクチュエータである。
The
次にこの第1実施例の作用について説明すると、車速Vおよびコーナーの半径Rに基づくコーナー半径基準目標ヨーレートγRが得られるときには、そのコーナー半径基準目標ヨーレートγRに実ヨーレートγが近づくようにアクチュエータ12が制御手段13により制御御するので、コーナー通過時の制御が遅れたり、過剰制御が生じたりすることを極力回避することができ、またナビゲーションシステムNの不調によって道路情報が得られない場合には、車速Vおよび舵角αに基づく舵角基準目標ヨーレートγαに実ヨーレートγが近づくようにアクチュエータ12を制御するので、適切な操縦安定制御を継続して実行することができる。
Next, the operation of the first embodiment will be described. When the corner radius reference target yaw rate γR based on the vehicle speed V and the corner radius R is obtained, the
しかも第2比較手段11の比較結果に基づくアクチュエータ12の制御に入ったときには、コーナー半径基準目標ヨーレートγRが得られるようになっても、制御手段13はその制御を終了するまで継続して実行するので、制御の途中で舵角基準目標ヨーレートγαおよびコーナー半径基準目標ヨーレートγRに基づく制御が頻繁に切り換わったり、制御の干渉が生じるのを防止することができるとともに、車両運転者の操縦意志を尊重した制御を行うことができる。
In addition, when the control of the
さらに舵角基準目標ヨーレートγαが、コーナー半径基準目標ヨーレートγRおよび舵角基準目標ヨーレートγαの偏差に基づいて補正手段10により補正されるので、コーナー半径基準目標ヨーレートγRおよび実ヨーレートγの比較に基づく制御、ならびに舵角基準目標ヨーレートγαおよび実ヨーレートγの比較に基づく制御の切換時に、制御量が大きく変化することを回避し、車両運転者が違和感を感じることがないようにして制御の切換えを滑らかにすることができる。 Further, since the rudder angle reference target yaw rate γα is corrected by the correcting means 10 based on the deviation between the corner radius reference target yaw rate γR and the rudder angle reference target yaw rate γα, it is based on the comparison between the corner radius reference target yaw rate γR and the actual yaw rate γ. When switching the control based on the comparison of the steering angle reference target yaw rate γα and the actual yaw rate γ, the control amount is avoided from changing greatly, and the control is switched so that the vehicle driver does not feel uncomfortable. Can be smooth.
本発明の第2実施例として、上記第1実施例の制御手段13が、第1および第2比較手段9,11の比較結果に基づいて定まる制御量のうち大きな制御量となる側を選択してアクチュエータ12の作動を制御するとともに第2比較手段11の比較結果に基づくアクチュエータ12の制御を実行中には第1比較手段9の比較結果とは無関係にその制御終了まで第2比較手段11の比較結果に基づく制御を続行するものであってもよい。
As a second embodiment of the present invention, the control means 13 of the first embodiment selects the side with the larger control amount among the control amounts determined based on the comparison results of the first and second comparison means 9 and 11. Thus, while controlling the operation of the
この第2実施例によれば、コーナー半径基準目標ヨーレートγRおよび実ヨーレートγの比較に基づく制御、ならびに舵角基準目標ヨーレートγαおよび実ヨーレートγの比較に基づく制御のうち、制御量が大きくなるほうを選択してアクチュエータ12を制御するので、コーナー通過時の制御が遅れたり、過剰制御が生じたりすることを極力回避するとともに、道路情報が得られない場合にも、車両運転者の操舵意志により適合した操縦安定制御を実行することが可能である。しかも舵角基準目標ヨーレートγαおよび実ヨーレートγの比較結果に基づくアクチュエータ12の制御に入ったときには、制御手段13がその制御を終了するまで継続して実行するので、制御の途中で舵角基準目標ヨーレートγαに基づく制御およびコーナー半径基準目標ヨーレートγRに基づく制御が頻繁に切り換わったり、制御の干渉が生じるのを防止することができるとともに、車両運転者の操縦意志を尊重した制御を行うことができる。
According to the second embodiment, among the control based on the comparison between the corner radius reference target yaw rate γR and the actual yaw rate γ, and the control based on the comparison between the steering angle reference target yaw rate γα and the actual yaw rate γ, the control amount becomes larger. Is selected and the
図4は本発明の第3実施例を示すものであり、コーナー半径基準目標運動パラメータ決定手段5で決定されたコーナー半径基準目標ヨーレートγRと、舵角基準目標運動パラメータ決定手段7で決定されるとともに補正手段10で補正された舵角基準目標ヨーレートγα′と、実運動パラメータ検出手段8で検出された実ヨーレートγとが比較手段14に入力される。
FIG. 4 shows a third embodiment of the present invention. The corner radius reference target yaw rate γR determined by the corner radius reference target motion parameter determination means 5 and the steering angle reference target motion parameter determination means 7 are determined. At the same time, the steering angle reference target yaw rate γα ′ corrected by the
この比較手段14は、基本的にはコーナー半径基準目標ヨーレートγRおよび実ヨーレートγを比較するのであるが、コーナー半径基準目標運動パラメータ決定手段5がナビゲーションシステムNの不調によってコーナー半径基準目標ヨーレートγRを決定不能な状態では舵角基準目標ヨーレートγα′および実ヨーレートγを比較する。 The comparison means 14 basically compares the corner radius reference target yaw rate γR and the actual yaw rate γ, but the corner radius reference target motion parameter determination means 5 determines the corner radius reference target yaw rate γR due to the malfunction of the navigation system N. In the indeterminate state, the steering angle reference target yaw rate γα ′ and the actual yaw rate γ are compared.
この比較手段14による比較結果は制御手段13に入力され、制御手段13は比較手段14の比較結果に基づいてアクチュエータ12の作動を制御する。
The comparison result by the comparison means 14 is input to the control means 13, and the control means 13 controls the operation of the
この第3実施例によれば、比較手段14は、コーナー半径基準目標ヨーレートγRが得られるときには、そのコーナー半径基準目標ヨーレートγRおよび実ヨーレートγを比較し、コーナー半径基準目標ヨーレートγRが得られないときには、補正後の舵角基準目標ヨーレートγα′および実ヨーレートγを比較するものであり、コーナー通過時の制御が遅れたり、過剰制御が生じたりすることを極力回避することができる。また道路情報が得られない場合には、舵角基準目標ヨーレートγα′に実ヨーレートγが近づくようにアクチュエータ12が制御されるので、適切な操縦安定制御を継続して実行することができる。
According to the third embodiment, when the corner radius reference target yaw rate γR is obtained, the comparison means 14 compares the corner radius reference target yaw rate γR with the actual yaw rate γR, and the corner radius reference target yaw rate γR cannot be obtained. In some cases, the corrected steering angle reference target yaw rate γα ′ and the actual yaw rate γ are compared, and it is possible to avoid as much as possible that control at the time of passing the corner is delayed or excessive control occurs. When the road information cannot be obtained, the
以上、本発明の実施例を説明したが、本発明は上記実施例に限定されるものではなく、特許請求の範囲に記載された本発明を逸脱することなく種々の設計変更を行うことが可能である。 Although the embodiments of the present invention have been described above, the present invention is not limited to the above-described embodiments, and various design changes can be made without departing from the present invention described in the claims. It is.
たとえば上記実施例では、自車の旋回運動状態を表す運動パラメータとしてヨーレートを用いた場合について説明したが、スリップ率、横方向加速度およびスリップ角(車体の横滑り角)を前記運動パラメータして用いてもよい。 For example, in the above embodiment, the case where the yaw rate is used as the motion parameter representing the turning motion state of the own vehicle has been described. However, the slip rate, the lateral acceleration, and the slip angle (the side slip angle of the vehicle body) are used as the motion parameters. Also good.
1・・・道路データ記憶手段
2・・・自車位置検出手段
3・・・車速検出手段
4・・・コーナー半径検出手段
5・・・コーナー半径基準目標運動パラメータ決定手段
6・・・舵角検出手段
7・・・舵角基準目標運動パラメータ決定手段
8・・・実運動パラメータ検出手段
9・・・第1比較手段
10・・・補正手段
11・・・第2比較手段
12・・・アクチュエータ
13・・・制御手段
14・・・比較手段
DESCRIPTION OF
Claims (5)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004094159A JP4511859B2 (en) | 2004-03-29 | 2004-03-29 | Vehicle motion control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004094159A JP4511859B2 (en) | 2004-03-29 | 2004-03-29 | Vehicle motion control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2005280402A true JP2005280402A (en) | 2005-10-13 |
JP4511859B2 JP4511859B2 (en) | 2010-07-28 |
Family
ID=35179261
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004094159A Expired - Fee Related JP4511859B2 (en) | 2004-03-29 | 2004-03-29 | Vehicle motion control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4511859B2 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009119921A (en) * | 2007-11-12 | 2009-06-04 | Mitsubishi Electric Corp | Vehicular steering device and vehicle control device |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08263790A (en) * | 1995-03-23 | 1996-10-11 | Honda Motor Co Ltd | Steering controller for vehicle |
JPH11240458A (en) * | 1998-02-25 | 1999-09-07 | Fuji Heavy Ind Ltd | Vehicle movement control unit |
JP2002120711A (en) * | 2000-10-11 | 2002-04-23 | Fuji Heavy Ind Ltd | Vehicle behavior control device |
JP2003011806A (en) * | 2001-07-02 | 2003-01-15 | Mazda Motor Corp | Automotive posture control system |
JP3464732B2 (en) * | 1995-07-14 | 2003-11-10 | 本田技研工業株式会社 | Vehicle brake control device |
JP2004168154A (en) * | 2002-11-19 | 2004-06-17 | Fuji Heavy Ind Ltd | Vehicle behavior control device |
-
2004
- 2004-03-29 JP JP2004094159A patent/JP4511859B2/en not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08263790A (en) * | 1995-03-23 | 1996-10-11 | Honda Motor Co Ltd | Steering controller for vehicle |
JP3464732B2 (en) * | 1995-07-14 | 2003-11-10 | 本田技研工業株式会社 | Vehicle brake control device |
JPH11240458A (en) * | 1998-02-25 | 1999-09-07 | Fuji Heavy Ind Ltd | Vehicle movement control unit |
JP2002120711A (en) * | 2000-10-11 | 2002-04-23 | Fuji Heavy Ind Ltd | Vehicle behavior control device |
JP2003011806A (en) * | 2001-07-02 | 2003-01-15 | Mazda Motor Corp | Automotive posture control system |
JP2004168154A (en) * | 2002-11-19 | 2004-06-17 | Fuji Heavy Ind Ltd | Vehicle behavior control device |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009119921A (en) * | 2007-11-12 | 2009-06-04 | Mitsubishi Electric Corp | Vehicular steering device and vehicle control device |
JP4707703B2 (en) * | 2007-11-12 | 2011-06-22 | 三菱電機株式会社 | Vehicle steering system |
Also Published As
Publication number | Publication date |
---|---|
JP4511859B2 (en) | 2010-07-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6099600B2 (en) | Vehicle steering system | |
WO2017122723A1 (en) | Parking support system, parking support method and program | |
CN106043302B (en) | The cruise active control system and its method of vehicle | |
US11155257B2 (en) | Automatic parking control device | |
CN107585163A (en) | Mobile Route Generation device and mobile route generation method | |
US20100324771A1 (en) | Autonomous moving body, its control method, and control system | |
US20170088176A1 (en) | Vehicle steering device | |
WO2017077807A1 (en) | Vehicle travel control device | |
JP5299756B2 (en) | vehicle | |
KR20150034400A (en) | Apparatus and method for controlling lane keeping | |
JP6419671B2 (en) | Vehicle steering apparatus and vehicle steering method | |
JP2007001475A (en) | Automatic steering control device | |
US11738749B2 (en) | Methods, systems, and apparatuses for scenario-based path and intervention adaptation for lane-keeping assist systems | |
JP6500118B2 (en) | Vehicle speed matching method and apparatus for vehicle | |
JPH09301210A (en) | Traveling control device | |
US11939015B2 (en) | Vehicle control device and vehicle control method | |
US11975775B2 (en) | Steering control device and steering control method | |
JP4599835B2 (en) | Automatic steering control device for vehicle | |
JP2005088834A (en) | Suspension controlling method and device, vehicle control system, navigation device, recording medium, and center | |
JP2006213073A (en) | Preceding vehicle recognition device | |
JP4511859B2 (en) | Vehicle motion control device | |
JP7268990B2 (en) | Vehicle automatic steering controller | |
JP2007195386A (en) | Driving force controller of electric vehicle and driving force control method of car and electric vehicle | |
JP4403962B2 (en) | Automatic steering control device | |
JP3896994B2 (en) | Vehicle travel support device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070216 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20090109 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090805 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20091005 |
|
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: 20100428 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20100507 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130514 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |