JP2009208587A - 四輪車両及びプログラム - Google Patents
四輪車両及びプログラム Download PDFInfo
- Publication number
- JP2009208587A JP2009208587A JP2008053129A JP2008053129A JP2009208587A JP 2009208587 A JP2009208587 A JP 2009208587A JP 2008053129 A JP2008053129 A JP 2008053129A JP 2008053129 A JP2008053129 A JP 2008053129A JP 2009208587 A JP2009208587 A JP 2009208587A
- Authority
- JP
- Japan
- Prior art keywords
- deviation
- rear wheel
- front wheel
- wheel
- steering
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Power Steering Mechanism (AREA)
- Steering-Linkage Mechanisms And Four-Wheel Steering (AREA)
Abstract
【課題】横風などの外乱の抑制だけでなく全体のバランスの向上をはかった操舵制御をする四輪車両を提供すること。
【解決手段】前輪及び後輪の撃心の目標軌道と実際の走行軌道との軌道偏差に基づいて前輪及び後輪を独立にスライディングモード制御する。後輪の軌道偏差に基づいて後輪を、スライディングモード制御するが、その際の非線形ゲインを前輪操舵より小さく同方向に後輪を操舵するように設定する。これにより、外乱の抑制だけでなく全体のバランスの向上をはかることができる。
【選択図】図1
【解決手段】前輪及び後輪の撃心の目標軌道と実際の走行軌道との軌道偏差に基づいて前輪及び後輪を独立にスライディングモード制御する。後輪の軌道偏差に基づいて後輪を、スライディングモード制御するが、その際の非線形ゲインを前輪操舵より小さく同方向に後輪を操舵するように設定する。これにより、外乱の抑制だけでなく全体のバランスの向上をはかることができる。
【選択図】図1
Description
本発明は、四輪車両に関し、特に、横風などの外乱を受けても、その影響を抑制するように車輪の操舵を自動制御する四輪車両及びプログラムに関する。
四輪操舵の車両において横風などの外乱を抑制するように前輪と後輪を独立に制御することが提案されている(例えば、非特許文献1、2参照)。
熊本博光、外、「低次元化スライディングモードと特異注視点による自動車の操舵制御」、計測自動制御学会論文集、1998年、第34巻、第5号、p.393−399 熊本博光、外、「円弧接続コース上のロバスト自動操舵」、計測自動制御学会論文集、1999年、第35巻、第3号、p.340−348
熊本博光、外、「低次元化スライディングモードと特異注視点による自動車の操舵制御」、計測自動制御学会論文集、1998年、第34巻、第5号、p.393−399 熊本博光、外、「円弧接続コース上のロバスト自動操舵」、計測自動制御学会論文集、1999年、第35巻、第3号、p.340−348
しかし、従来提案されている手法は外乱を抑制するものではあっても、制御の安定性が十分に考慮されていなかった。
本発明は、上記問題点に鑑み、外乱の抑制だけでなく全体のバランスの向上をはかった操舵制御をする四輪車両及びプログラムを提供することを目的とする。
本発明の請求項1に係る四輪車両は、前輪の撃心の所定の目標軌道と実際の走行軌道との前輪偏差を検出する前輪偏差検出手段と、後輪の撃心の所定の目標軌道と実際の走行軌道との後輪偏差を検出する後輪偏差検出手段と、前記前輪偏差に基づき前輪の操舵を前記目標軌道にスライディングモード制御する前輪制御手段と、前輪操舵より小さく同方向に後輪の操舵を制御するように非線形ゲインを設定して、前記後輪偏差に基づき後輪の操舵を前記目標軌道にスライディングモード制御する後輪制御手段とを備えることを特徴とする。
また、本発明の請求項2に係る四輪車両は、前記前輪制御手段及び後輪制御手段は、(ε1,ε2)座標面上(ここで、ε1:偏差距離、ε2:偏差速度)の原点を通る曲線(この曲線は直線を含む。)を切換面とするスライディングモード制御することを特徴とする。
また、請求項3に係る発明は、コンピュータを、前輪の撃心の所定の目標軌道と実際の走行軌道との前輪偏差を検出する前輪偏差検出手段と、後輪の撃心の所定の目標軌道と実際の走行軌道との後輪偏差を検出する後輪偏差検出手段と、前記前輪偏差に基づき前輪の操舵を前記目標軌道にスライディングモード制御する前輪制御手段と、前輪操舵より小さく同方向に後輪の操舵を制御するように非線形ゲインを設定して、前記後輪偏差に基づき後輪の操舵を前記目標軌道にスライディングモード制御する後輪制御手段とを備える四輪車両として機能させるためのプログラムである。
本発明によれば、四輪車両において、外乱の抑制だけでなく全体のバランスの向上をはかった操舵制御をすることができる。
以下、添付図面を参照しながら本発明を実施するための最良の形態について詳細に説明する。
図1は、本発明の一実施例による四輪車両の構成を示す図である。図は特に制御系に関する構成を示している。本実施例の四輪車両は、前輪偏差検出手段11、後輪偏差検出手段12、前輪スライディングモード制御手段13、及び後輪スライディングモード制御手段14から成る。前輪偏差検出手段11、後輪偏差検出手段12は、前輪偏差及び後輪偏差を検出する。前輪偏差及び後輪偏差は、それぞれ、前輪及び後輪の撃心の目標軌道と実際の走行軌道との軌道偏差である。この軌道偏差を検出するには具体的には例えば2次元加速度センサ及び角速度センサによる車両の位置検出によって実現すれば良い。前輪スライディングモード制御手段13は、前輪偏差検出手段11が検出した前輪の軌道偏差に基づいて前輪を目標軌道に戻すようにスライディングモード制御する。スライディングモード制御に関しては後述する。後輪スライディングモード制御手段14は、後輪偏差検出手段12が検出した後輪の軌道偏差に基づいて後輪を、前輪制御とは独立してスライディングモード制御するが、その際の非線形ゲインを前輪操舵より小さく同方向に後輪を操舵するように設定する。これにより、外乱の抑制だけでなく全体のバランスの向上をはかることができる。
以下、本発明の動作を説明する。
図2は、四輪車両モデルを示す図である。まず、四輪操舵で制御対象として取り扱う4輪車両モデルを記述する。
車線位置保持に関わる車両の運動方程式
回転方向の運動方程式
ここで、
I:車両の慣性モーメント
γ:ヨーレート(z軸周りの回転の角速度)
m:車両質量
β:車両の横滑り角(車両の姿勢方向と進行方向のなす角)
Fflx,Ffrx,FRlx,FRrx:各車輪に働く制駆動力
Ffly,Ffry,FRly,FRry:各車輪で発生する横力
G:重心
v:速度
車線位置保持に関わる車両の運動方程式
I:車両の慣性モーメント
γ:ヨーレート(z軸周りの回転の角速度)
m:車両質量
β:車両の横滑り角(車両の姿勢方向と進行方向のなす角)
Fflx,Ffrx,FRlx,FRrx:各車輪に働く制駆動力
Ffly,Ffry,FRly,FRry:各車輪で発生する横力
G:重心
v:速度
(1)式の各車輪で発生する横力はコーナリングフォースとの関係を考慮して次式で設定する。
前後輪タイヤのそれぞれの横滑り角は、
ここで、
ufr,ufl,uRr,uRl:前後輪の操舵角
Kfr,Kfl,KRr,KRl:前後輪のコーナリングパワー
となる。
ufr,ufl,uRr,uRl:前後輪の操舵角
Kfr,Kfl,KRr,KRl:前後輪のコーナリングパワー
となる。
4輪モデルのままでは非線形システムのため、制御器の設計する際に線形化を行う。以下に近似による線形化した二輪車両の状態方程式を述べ、線形方程式を元に制御器を設計する。
二輪車両の運動を考慮して線形化した車両状態方程式は(11)式となる。
ここで、
Kf,Kr:前後輪コーナリングパワー(四輪車両の前輪の左右がKf、後輪の左右もそれぞれKrとみなす)
w:車速に垂直に入る横風などの外乱
ただし、横滑り角β、前輪操舵角uf、後輪操舵角ur、ヨーレートγが微小であると仮定した。
Kf,Kr:前後輪コーナリングパワー(四輪車両の前輪の左右がKf、後輪の左右もそれぞれKrとみなす)
w:車速に垂直に入る横風などの外乱
ただし、横滑り角β、前輪操舵角uf、後輪操舵角ur、ヨーレートγが微小であると仮定した。
操舵制御の目的は車線位置保持と姿勢の安定化である。車線位置の基準点は車両重心位置ではなく,(12)式の前後注視点を用いる。
この点は撃心と呼ばれ、偏差を抑制するための前後輪操舵角の制御則がお互い干渉せずに決定可能な点として知られている。後輪に対応する撃心を前方基準点P、後輪に対応する撃心を前方基準点Qとする。
P、Q点を基準にすることで目標車線位置への保持を図る。
つぎに、図3を参照して、車線位置保持を目的とするため車両を地上に固定した場合の車両方程式を設定する。前後基準点の目標軌道と実際の走行軌道との軌道偏差をεp,εqとする。
ここで、
yp,yq:前後基準点の走行軌道のy軸方向の距離
zp,zq:前後基準点の目標軌道のy軸方向の距離
yp,yq:前後基準点の走行軌道のy軸方向の距離
zp,zq:前後基準点の目標軌道のy軸方向の距離
この軌道偏差を0にすることによって車両を目標位置に保持できる。前後輪の軌道偏差は重心点を考慮して次式に書き換えられる。
ここで(15),(16)式を考慮して(11)式の車両状態方程式を変換すると、軌道偏差の状態方程式(17),(18)式となる。
ここで、
lw:横風の影響によって車体に力が加わる地点と車体の中心から距離差
(17),(18)式よりこのシステムは前方軌道偏差と後方軌道偏差のそれぞれの状態システムに分割する事が可能なため、前輪と後輪の操舵角はお互い干渉せずに独立して制御できることがわかる。
lw:横風の影響によって車体に力が加わる地点と車体の中心から距離差
(17),(18)式よりこのシステムは前方軌道偏差と後方軌道偏差のそれぞれの状態システムに分割する事が可能なため、前輪と後輪の操舵角はお互い干渉せずに独立して制御できることがわかる。
この軌道偏差方程式にスライディングモード制御を適用する。パラメータ変動としてコーナリングパワーの不確かさを利用し、外乱として横風を与える。(17)式(18)式はマッチング条件を考慮すると次のようにまとめられる。
この状態方程式に対応する切換関数を次に定義する。
ここで、
S=(Sp1,q1,Sp2,q2):切換面
例えばSp=[−0.8 −0.8]、このときσp=0として切換面はεp2=−(−0.8/−0.8)εp1、すなわち、εp2=−εp1、また、例えばSq=[−0.8 −0.5]。ここでは、切換面が(ε1,ε2)座標面上の直線の例を示したが、原点を通り車両の状態を原点に移動させることができる任意の曲線とすることができる。
εp1,εq1:偏差の距離
εp2,εq2:偏差の速度
S=(Sp1,q1,Sp2,q2):切換面
例えばSp=[−0.8 −0.8]、このときσp=0として切換面はεp2=−(−0.8/−0.8)εp1、すなわち、εp2=−εp1、また、例えばSq=[−0.8 −0.5]。ここでは、切換面が(ε1,ε2)座標面上の直線の例を示したが、原点を通り車両の状態を原点に移動させることができる任意の曲線とすることができる。
εp1,εq1:偏差の距離
εp2,εq2:偏差の速度
このときのスライディングモード制御による入力は(24)式(25)式となる。
ここで、ηDp,ηDq:前後輪用のチャタリング抑制値
ただし、非線形ゲインρp,qは切換面の到達条件としてリアプノフ関数V=σσT/2の関係より、
ここで、l=lf+lr
を選択する。ただし、φはパラメータ変動、外乱の上界値である。
ただし、非線形ゲインρp,qは切換面の到達条件としてリアプノフ関数V=σσT/2の関係より、
を選択する。ただし、φはパラメータ変動、外乱の上界値である。
ゲインの設定は上記の値を考慮して調整すれば誤差を抑制することが可能である。しかし上記の条件内で設定したとしても選択値は幅広く前後輪のゲインのバランスによっては良い誤差抑制および安定性を得ることはできない。よってよりバランスの良い結果を得るための前後輪のゲイン関係を考える。(24),(25)式と(15),(16)式を考慮すると前後輪操舵角(19)式は次のように書き換えられる。
ここで、Sp2=n*lr/Kf、Sq2=n*lf/Kr、Sq1=Sp1(n:任意の定数)とおくと前輪操舵角と後輪操舵角の間には次の関係が得られる。
後輪を前輪より小さく同方向に操舵することを考慮すると、
の関係が成り立てば後輪は前輪より小さく操舵できる。なおσp,σqがどちらも負の場合は
σp,σqがどちらも正の場合は、
が成り立ち、かつ(26)式で定めた範囲のゲインを選択すればよい。
シミュレーションで用いる軌道は次のように設定する。車両はy=310[m]の地点からスタートするとし、y=300[m]の軌道に追従させる。コーナリングパワーには不確かさを含み、途中、t=8[s]からt=15[s]の間w=3000[N]の横風外乱を与える。
前後輪の切換面はSp=[−0.8 −0.8],Sq=[−0.8 −0.5]、非線形入力のチャタリング対策にη=0.9、非線形ゲインとしてρp=0.3,ρq=0.2と設定した。このシミュレーションの場合,切換関数はσ<0であり、γ=0のため(30)式よりρp>ρqと(26)を満たすゲインが成り立てばよい。図4は上記を満たしている。この場合、目標値誤差は緩やかに減少し、外乱やパラメータの変動の影響を抑制し安定している。ここで(26)式を満たすが(30)式は満たしていない非線形ゲインとしてρp=0.3,ρq=0.4を与えた場合、発散はしないものの安定性は保たれていない結果が得られている。
表1 シミュレーションパラメータ
なお、本発明は上記実施例に限定されるものではない。
表1 シミュレーションパラメータ
本発明の四輪車両は、コンピュータを本四輪車両として機能させるためのプログラムでも実現される。このプログラムは、コンピュータで読み取り可能な記録媒体に格納されていてもよい。
このプログラムを記録した記録媒体は、図1に示される四輪車両のROMそのものであってもよいし、また、外部記憶装置としてCD−ROMドライブ等のプログラム読取装置が設けられ、そこに記録媒体を挿入することで読み取り可能なCD−ROM等であってもよい。
また、上記記録媒体は、磁気テープ、カセットテープ、フレキシブルディスク、ハードディスク、MO/MD/DVD等、又は半導体メモリであってもよい。
11 前輪偏差検出手段
12 後輪偏差検出手段
13 前輪スライディングモード制御手段
14 後輪スライディングモード制御手段
12 後輪偏差検出手段
13 前輪スライディングモード制御手段
14 後輪スライディングモード制御手段
Claims (3)
- 前輪の撃心の所定の目標軌道と実際の走行軌道との前輪偏差を検出する前輪偏差検出手段と、
後輪の撃心の所定の目標軌道と実際の走行軌道との後輪偏差を検出する後輪偏差検出手段と、
前記前輪偏差に基づき前輪の操舵を前記目標軌道にスライディングモード制御する前輪制御手段と、
前輪操舵より小さく同方向に後輪の操舵を制御するように非線形ゲインを設定して、前記後輪偏差に基づき後輪の操舵を前記目標軌道にスライディングモード制御する後輪制御手段と
を備えることを特徴とする四輪車両。 - 前記前輪制御手段及び後輪制御手段は、(ε1,ε2)座標面上(ここで、ε1:偏差距離、ε2:偏差速度)の原点を通る曲線(この曲線は直線を含む。)を切換面とするスライディングモード制御することを特徴とする請求項1記載の四輪車両。
- コンピュータを、
前輪の撃心の所定の目標軌道と実際の走行軌道との前輪偏差を検出する前輪偏差検出手段と、後輪の撃心の所定の目標軌道と実際の走行軌道との後輪偏差を検出する後輪偏差検出手段と、前記前輪偏差に基づき前輪の操舵を前記目標軌道にスライディングモード制御する前輪制御手段と、前輪操舵より小さく同方向に後輪の操舵を制御するように非線形ゲインを設定して、前記後輪偏差に基づき後輪の操舵を前記目標軌道にスライディングモード制御する後輪制御手段とを備える四輪車両
として機能させるためのプログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008053129A JP2009208587A (ja) | 2008-03-04 | 2008-03-04 | 四輪車両及びプログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008053129A JP2009208587A (ja) | 2008-03-04 | 2008-03-04 | 四輪車両及びプログラム |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2009208587A true JP2009208587A (ja) | 2009-09-17 |
Family
ID=41182163
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008053129A Pending JP2009208587A (ja) | 2008-03-04 | 2008-03-04 | 四輪車両及びプログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2009208587A (ja) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012003452A (ja) * | 2010-06-16 | 2012-01-05 | Isuzu Motors Ltd | スライディングモード制御装置及び車両の自動操舵制御装置 |
KR20160059823A (ko) * | 2014-11-19 | 2016-05-27 | 현대모비스 주식회사 | 차선 유지보조 시스템 및 방법 |
CN108153309A (zh) * | 2017-12-22 | 2018-06-12 | 安徽农业大学 | 用于履带机器人的控制方法以及履带机器人 |
JPWO2021111616A1 (ja) * | 2019-12-06 | 2021-06-10 | ||
CN114701565A (zh) * | 2022-05-27 | 2022-07-05 | 北京理工大学 | 一种四轮转向独立轮转向驱动装置及其控制方法 |
JP2022112302A (ja) * | 2021-01-21 | 2022-08-02 | いすゞ自動車株式会社 | 操舵制御装置及び操舵制御方法 |
-
2008
- 2008-03-04 JP JP2008053129A patent/JP2009208587A/ja active Pending
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012003452A (ja) * | 2010-06-16 | 2012-01-05 | Isuzu Motors Ltd | スライディングモード制御装置及び車両の自動操舵制御装置 |
KR102270287B1 (ko) * | 2014-11-19 | 2021-06-29 | 현대모비스 주식회사 | 차선 유지보조 시스템 및 방법 |
KR20160059823A (ko) * | 2014-11-19 | 2016-05-27 | 현대모비스 주식회사 | 차선 유지보조 시스템 및 방법 |
KR102355735B1 (ko) * | 2014-11-19 | 2022-02-09 | 현대모비스 주식회사 | 차선 유지보조 시스템 및 방법 |
KR20210087006A (ko) * | 2014-11-19 | 2021-07-09 | 현대모비스 주식회사 | 차선 유지보조 시스템 및 방법 |
CN108153309B (zh) * | 2017-12-22 | 2020-11-10 | 安徽农业大学 | 用于履带机器人的控制方法以及履带机器人 |
CN108153309A (zh) * | 2017-12-22 | 2018-06-12 | 安徽农业大学 | 用于履带机器人的控制方法以及履带机器人 |
WO2021111616A1 (ja) * | 2019-12-06 | 2021-06-10 | 三菱電機株式会社 | 車両制御装置および車両制御方法 |
JPWO2021111616A1 (ja) * | 2019-12-06 | 2021-06-10 | ||
JP7229391B2 (ja) | 2019-12-06 | 2023-02-27 | 三菱電機株式会社 | 車両制御装置および車両制御方法 |
JP2022112302A (ja) * | 2021-01-21 | 2022-08-02 | いすゞ自動車株式会社 | 操舵制御装置及び操舵制御方法 |
JP7327419B2 (ja) | 2021-01-21 | 2023-08-16 | いすゞ自動車株式会社 | 操舵制御装置及び操舵制御方法 |
CN114701565A (zh) * | 2022-05-27 | 2022-07-05 | 北京理工大学 | 一种四轮转向独立轮转向驱动装置及其控制方法 |
CN114701565B (zh) * | 2022-05-27 | 2022-08-30 | 北京理工大学 | 一种四轮转向独立轮转向驱动装置及其控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7640089B2 (en) | Vehicle-trailer stability and handling performance improvement using rear-wheel steering control | |
US8935050B2 (en) | Moving body control system, moving body control method, and non-transitory computer readable medium storing control program | |
US9090285B2 (en) | Method for providing a lanekeeping assistance based on modifying mechanical sources of steering torques | |
US6909957B2 (en) | Method for controlling yaw and transversal dynamics in a road vehicle | |
JP2009208587A (ja) | 四輪車両及びプログラム | |
US8494719B2 (en) | Method and apparatus for controlling active rear steering | |
CN111572558A (zh) | 一种无人车最大包络线动力学控制方法 | |
CN112109732A (zh) | 一种智能驾驶自适应曲线预瞄方法 | |
JP5052165B2 (ja) | 船舶用自動操舵装置 | |
Lenain et al. | Accurate and stable mobile robot path tracking: An integrated solution for off-road and high speed context | |
JP4613668B2 (ja) | 車両挙動制御装置および車両挙動制御方法 | |
Xin et al. | Backstepping vehicle steering controller using integral and robust control based on dynamic state estimation | |
JP2011068207A (ja) | 車両制御装置 | |
CN113396093A (zh) | 用于自主控制设备移动性的方法 | |
Woods et al. | Modelling of a 4WS4WD vehicle and its control for path tracking | |
CN115826579A (zh) | 一种兼顾横向误差和航向误差收敛的自动驾驶控制方法 | |
Xin et al. | Variable structure backstepping control via a hierarchical manifold set for graceful ground vehicle path following | |
JP5483194B2 (ja) | スライディングモード制御装置及び車両の自動操舵制御装置 | |
JP4232650B2 (ja) | 車両用パワーステアリング装置 | |
JP5617499B2 (ja) | 車両用舵角制御装置 | |
JP3182972B2 (ja) | 車両の後輪操舵制御装置 | |
CN113050650A (zh) | 基于输出反馈的无人车路径跟踪控制方法及系统 | |
JP4123158B2 (ja) | 車両用パワーステアリング装置及び車両用外乱推定装置 | |
JP4367196B2 (ja) | 車両用パワーステアリング装置及び車両用外乱推定装置 | |
JP2009275560A (ja) | 車両の駆動力制御装置 |