第一章 簡介
1.2 大綱
本論文架構如下所述。第一章為本論文的動機及一些相關的文獻 探討。第二章介紹相關基礎理論:輸入-狀態回授線性化控制方法,最佳 化控制理論,取樣理論,及四階 Runge-Kutta 非線性數值模擬技巧。第 三章介紹本論文探討之車輛轉向系統模型及回顧其在鞍點分歧點上所 產生之系統鞍節點分歧現象 ,據以說明本論文所探討之控制問題 。為 能後續驗證本論文所提出控制方法之有效性 ,本章將提供車輛系統在 不同重量、速度、初始條件(外擾)、路面摩擦力下之最大安全輸入範 圍。第四章提出基於輸入-狀態回授線性化控制方法之一線性非時變控 制模型,以降低回授線性化控制所需之複雜計算度。另外,將說明如 何利用最佳化控制理論,來求出此一線性非時變控制之最佳固定增益 值。第五章提出一針對車輛轉向系統控制之離散時間控制方法 ,以因 應現今較實際之數位控制器設計需求 。第六章將以數值模擬驗證本論 文所提出之連續時間及離散時間控制器 之控制效能。最後,在第七章 中提出本論文的結論及未來可能的後續研究方向。
第 二 章 基礎理論介紹
本章對本論文中所用到的輸入-狀態回授線性化控制方法 及撰寫 模擬程式需使用到的四階朗基-庫塔數值模擬方法等相關基礎理論加以 介紹與說明。首先在 2.1 節中介紹本論文所採用的控制方法:輸入-狀態 回授線性化控制。其次,在 2.2 節中我們介紹四階朗基-庫塔數值模擬 方法之基本原理。
2.1 輸入-狀態回授線性化(Input-state feedback linearization)
假設有一仿射-型式(affine-type)非線性系統如下:
x g xu, fx
(2.2)
其 中 u 及 f :Dx n 和 g:Dx np 在 Dx n 域 都 充 分 平 滑
(sufficiently smooth) 。如果存在一個 diffeomorphism
T:Dx n使得
xz T D
D 包含原點且非線性映射zT
x 將系統(2.2)轉換成下式:
1 x u x
.B Az
z
(2.3)
其中,
A,B
具可控制性,和為純量函數,且對所有的xDx而言,
x 為非奇異解。定義zT
x ,我們可得 xx z T
,將(2.2)式代入可得下式:
f x g xu
.x x T x
z T
(2.4)
比較(2.3)及(2.4)式可得:
x AT
x B
x,比較(2.8a)與(2.8b)式,我們可得到下面關係式:
x T
x x fT
i i
1
,i1,2,,n1,
(2.9a)
x
x , x fTn
(2.9b)
0
g x x Ti
,i1,2,,n1,
(2.9c)
1 0.
x x x g Tn
(2.9d)
利用(2.9b)與(2.9d)式,我們可分別得到及的函式如下:
x Tn/x
f x,
(2.10a)
/
.1 x g x x T
n
(2.10b)
利用(2.9a)與(2.9c)式,我們可選擇適當的 T(x)函式(本論文在 4.2 節中 將針對車輛轉向系統詳述如何求取此一 T(x)函式)。選擇控制器輸出u 為狀態回授控制,其控制律定義如下:
x
x K T
x
,u
(2.11)
其中K為常數增益。利用關係 z=T(x),我們可將(2.11)式改寫如下:
x
x Kz
.u
(2.12)
將(2.12)式代入(2.3)式,我們可得下面線性系統:
A BK
z.z
(2.13)
因此,經由(2.3)~(2.13)式的回授線性化程序,我們可將原本的非線性 系統(2.2)式轉變成一線性系統模型(2.13)式。
2.2 四階朗基-庫塔數值模擬方法 (Fourth-order Runge-Kutta method)
第三章
車輛轉向系統橫向動力學模型與 分歧現象分析
在本章中,我們針對車輛轉向系統之橫向動力學模型分析其穩定 性,並探討在何種條件下,系統會發生側滑角與偏移率持續震盪或發 散的不穩定現象 。3.1 節介紹本論文所採用的車輛橫向動力學模型
[12]。3.2 節中,我們利用相平面分析軟體來解釋車輛轉向系統之鞍節
點分歧現象,並探討其系統穩定性,最後利用分析結果來討論一些參 數對車輛轉向控制的影響。3.1 車輛橫向動力學模型
本論文考慮一個典型的車輛轉向動力學數學模型 [12,13],其轉向 動力學方塊圖如圖 3.1 所示。在圖 3.1 中,v是縱向加速度,f為前輪 轉向角,是側滑角,是偏移率,CG為車輛重心,Lf和Lr分別為重 心和前後輪軸的間距,m是車輛的重量,IZ是 z 軸的搖擺力矩,Fyfl、
Fyfl、Fyfr、Fyrr分別為左前、左後、右前、右後輪轉向力;Fxfl、Fxfl、Fxfr、 Fxrr分別為左前、左後、右前、右後輪牽引力,Fyfl加Fyfr等於總前輪轉 向力Fyf ;Fyrl 加Fyrr等於總後輪轉向力Fyr;Fxfl加Fxfr等於總前輪牽引力
Fxf;Fxrl加Fxrr等於總後輪牽引力Fxr。若忽略滾動動作,轉向動力學方程 式如下式(3.1)~(3.3):
v v
Fxf Fxr Fyf sin f,m
(3.1)
Fyf Fyr Fxf sin f,其中,Bf、Cf、Df 、Ef、Br、Cr、Dr、Er皆為常數。通常Df 及Dr是 負數,Bf、Cf 、Br、Cr則皆為正數。
圖 3.1 車輛轉向動力學方塊圖
圖 3.2 等效轉向力特性圖
Fxfl
Fxrl
Fyrl
Fxrl
Fyrr
Fxrr
Fxfr
Fyfr
Lr Lf
Slip angle ,f r(rad)
轉向力
F,yf
Fyr
(N)
Fyf (高摩擦力路面)
Fyr(高摩擦力路面)
Fyf (低摩擦力路面)
Fyr(低摩擦力路面)
3.2 車輛轉向系統鞍節點分歧現象 分析
由於本論文考慮之車輛系統模型為二階非線性系統,因此可透過 相平面分析(以數值模擬的方式),進行系統平衡點穩定度的分析,並 研究在一些不同的狀況下(如速度不同、車重不同…),系統平衡點及 最大安全轉向角度範圍的變化。這裡的最大安全轉向範圍指的是在 相 平面分析軟體上,逐漸增加輸入(轉向角度)數值(增加到最大正數值 或是遞減至最小負數值),仍不致造成系統在分析軟體上找不到穩定平 衡點之所有輸入轉向角度所含括的範圍。下面我們將針對 pplane7 相平 面分析軟體針對系統 (3.4)-(3.5)做相平面分析,模擬使用的參數如表
3.1。
(關於 pplane7 軟體操作,請參考文獻[14]之說明)首先,我們利用 pplane7 軟體,當系統(3.4)-(3.5)在速度v25
m/s , 輸 入f 0 下 , 所 得 到 的 相 位 描 繪 圖 如 圖 3.3 所 示 , 其 中 座 標(x1,x2)=
, 。我們將(x1,x2)範圍限制在(x1,x2)=(1,1)內,可找出系統 有三組平衡點:a(0.000, 0.000)、b(-0.0497, 0.0969)、c(0.0497, -0.0969),其中 a 點稱為 Spiral sink,b 及 c 點為 Saddle point。以此三點為平衡點 所求得之系統特徵值如表 3.2 中所示,其中系統在 a 點上特徵值為複數 特徵值,其實數部分為負數,所以 a 點為穩定螺旋點;b 及 c 點的特徵 值為相異符號的實數,所以 b 及 c 點為鞍點。
其次,我們說明系統在 a、b 及 c 點上的穩定性。在 a 點附近只要
不接近 b、c 點且落入 b、c 點穩定流型內,系統的平衡點將趨近 a 點。
另外,以 b 及 c 點為平衡點所求得線性化系統之相位描繪圖如圖
3.4(a)、(b)所示。從圖中我們可清楚的看出,只有在
x2=[(-0.95603)/(-0.96161)]x1 這條線上,系統的解才會趨近鞍點。反之,
不在線上的部分則其解為無界。因此,我們可求得 b 及 c 點為不穩定 鞍點。
接著,我們可利用程式找出系統最大安全轉向角度範圍 (Matlab 程式詳見文獻[14]中附錄 C)。由程式可判定出在v25
m/s 下,當輸入 超出0.0113
rad 系統將會不穩定(系統響應如圖 3.5)。另外,我們以相 平面分析軟體分析:當輸入為0.0113
rad 及0.0114
rad 時,系統在相 平 面上 有何 變化 ? 模擬 結果 如圖 3.6 。 由 圖中可 看出 , 當輸 入為
rad 0114 .0 時,系統的穩定節點消失,系統呈現不穩定現象。其次,
藉由觀察輸入從0.0113
rad 遞減至0.0114
rad 時,系統在相平面上平 衡點位置的變化,可找出當輸入為-0.01135068635
rad 時,可在相平面上 找出一無法被辨識為何種特性的 節點(如圖 3.7)。觀察該點的 Jacobin 矩陣(如圖 3.8),其符合文獻[14]中 3.2.1 中條件 3,因而此點稱為鞍節 分歧點(saddle-node bifurcation point)。利用圖 3.7 及鞍節分歧點之對稱 特性,我們可求得文獻[7]中系統在速度25
m/s
下的分歧圖(bifurcationdiagram)(如圖 3.9 所示)
,其中藍色實線為穩定的節點,紅色虛線為鞍點,黑色圓圈則為鞍節分歧點。利用前述鞍節分歧點求取方法及表 3.1 的低摩擦力路面參數,進行速度對車輛行駛穩定度分析之數值模擬 。 在速度為 15、20、25、30、35、40
m /s
下可繪製出系統的分歧圖如圖3.10 所示,轉向角的穩定範圍(
如表 3.4 及圖 3.11 所示,其中藍色實線所包覆f的範圍為轉向角的穩定範圍)。
最後,我們可針對速度、高低摩擦力路面、車重等因素對車輛行 駛之穩定度分析結果(請參考文獻[14]之討論),得到以下之結論:
(1)速度對車輛行駛之穩定度分析 :當速度愈快時,車輛轉向系統愈早
發生分歧現象,使得系統的穩定結點愈早消失 ,導致轉向角度的穩定 範圍愈小。
(2)高低摩擦力路面對車輛行駛之穩定度分析 :在同樣的速度下,車輛
轉向系統在低摩擦力路面比在高摩擦力路面更早發生分歧現象 (請參 考圖 3.12:在速度為 25
m /s
下,車輛行駛在高低摩擦力路面時,車輛 轉向系統的分歧圖);在相同輸入下,車子行走於高摩擦力路面時的側 滑角與橫擺率皆遠小於低摩擦力路面(請參考圖 3.13:在相同輸入下,車子行走在低摩擦力路面與高摩擦力路面及在不同速度下 ,車子的側 滑角與橫擺率的比較);高摩擦力路面的最大安全轉向範圍高於低摩擦 力路面的最大安全轉向範圍(請參考圖 3.14:在不同速度下,高低摩 擦力路面所能產生之最大安全轉向範圍 )。綜合上述,低摩擦力路面對
車輛行駛之穩定度影響高於高摩擦力路面所產生之結果。
Br
9.0051 18.631
Cr
1.3 1.56
Dr
-5430 -1749.7
Er
-1.7908 -1.7908
表 3.2 系統平衡點特性表
Jacobian Matrix Eigenvalues Eigenvectors
a
-表 3.3 不同速度下的最大安全轉向角度範圍
m s
v /
f穩定範圍10
0.0568
15
0.026
20
0.0158
25
0.0113
30
0.0089
35
0.0076
40
0.0067
表 3.4 不同車重下車子的最大安全轉向 角度範圍
m s v30 /穩定節點 鞍點
M
最大安
全f 值 Mb
-0.0089 0.0249 -0.0593 0.0294 -0.0664
Mb
5 .
1
-0.0072 0.0248 -0.0384 0.0289 -0.0429
Mb2
-0.0064 0.0252 -0.0288 0.0280 -0.0311
Mb5 .
2
-0.0059 0.0249 -0.0227 0.0279 -0.0247
Mb3
-0.0056 0.0256 -0.0192 0.0269 -0.0200
x1 ' = ( - 25747/15000 sin(39/25 atan(1189714682109441/35184372088832 x1 + 1189714682109441/35184372088832 atan(6/5 x2/v cos(x1)) - 1189714682109441/35184372088832 ue - 1999/1000 atan(451/40 x1 + 451/40 atan(6/5 x2/v cos(x1)) - 451/40 ue))) - 17497/15000 sin(39/25 atan(3658850635097841/70368744177664 x1 - 3658850635097841/70368744177664 atan(13/10 x2/v cos(x1)) - 4477/2500 atan(18631/1000 x1 - 18631/1000 atan(13/10 x2/v cos(x1))))))/v - x2 x2 ' = ( - 25747/25000 sin(39/25 atan(1189714682109441/35184372088832 x1 + 1189714682109441/35184372088832 atan(6/5 x2/v cos(x1)) - 1189714682109441/35184372088832 ue - 1999/1000 atan(451/40 x1 + 451/40 atan(6/5 x2/v cos(x1)) - 451/40 ue))) + 227461/300000 sin(39/25 atan(3658850635097841/70368744177664 x1 - 3658850635097841/70368744177664 atan(13/10 x2/v cos(x1)) - 4477/2500 atan(18631/1000 x1 - 18631/1000 atan(13/10 x2/v cos(x1)))))) cos(x1)v = 25
ue = 0
-1 -0.8 -0.6 -0.4 -0.2 0 0.2 0.4 0.6 0.8 1
-1 -0.8 -0.6 -0.4 -0.2 0 0.2 0.4 0.6 0.8 1
x1
x2
b a
c
圖 3.3 系統在速度v25
m/s 、輸入f 0下之相位描繪圖u' = A u + B v
v' = C u + D v B = -1.0379
D = -0.67485 A = -0.9284
C = -11.8556
-1 -0.5 0 0.5 1
-1 -0.8 -0.6 -0.4 -0.2 0 0.2 0.4 0.6 0.8 1
u
v
圖 3.4(a) 以鞍點 b 為平衡點所生成線性化系統之相位描繪圖
u' = A u + B v
v' = C u + D v B = -1.0379
D = -0.67485 A = -0.9284
C = -11.8556
-1 -0.5 0 0.5 1
-1 -0.8 -0.6 -0.4 -0.2 0 0.2 0.4 0.6 0.8 1
u
v
圖 3.4(b) 以鞍點 c 為平衡點所生成線性化系統之相位描繪圖
0 2 0 4 0 6 0 8 0 1 0 0
- 0 . 0 1 0 0 . 0 1 0 . 0 2 0 . 0 3
t
(rad)
0 2 0 4 0 6 0 8 0 1 0 0
- 0 . 0 8 - 0 . 0 6 - 0 . 0 4 - 0 . 0 2 0
t
(rad/s)
圖 3.5(a) v25m/s,f 0.0113系統響應圖
0 2 0 4 0 6 0 8 0 1 0 0
- 2 0 2 4
t
(rad)
0 2 0 4 0 6 0 8 0 1 0 0
- 1 - 0 . 5 0 0 . 5 1
t
(rad/s)
圖 3.5(b) v 25m/s,f 0.0114系統響應圖
x1 ' = ( - 25747/15000 sin(39/25 atan(1189714682109441/35184372088832 x1 + 1189714682109441/35184372088832 atan(6/5 x2/v cos(x1)) - 1189714682109441/35184372088832 ue - 1999/1000 atan(451/40 x1 + 451/40 atan(6/5 x2/v cos(x1)) - 451/40 ue))) - 17497/15000 sin(39/25 atan(3658850635097841/70368744177664 x1 - 3658850635097841/70368744177664 atan(13/10 x2/v cos(x1)) - 4477/2500 atan(18631/1000 x1 - 18631/1000 atan(13/10 x2/v cos(x1))))))/v - x2 x2 ' = ( - 25747/25000 sin(39/25 atan(1189714682109441/35184372088832 x1 + 1189714682109441/35184372088832 atan(6/5 x2/v cos(x1)) - 1189714682109441/35184372088832 ue - 1999/1000 atan(451/40 x1 + 451/40 atan(6/5 x2/v cos(x1)) - 451/40 ue))) + 227461/300000 sin(39/25 atan(3658850635097841/70368744177664 x1 - 3658850635097841/70368744177664 atan(13/10 x2/v cos(x1)) - 4477/2500 atan(18631/1000 x1 - 18631/1000 atan(13/10 x2/v cos(x1)))))) cos(x1)v = 25
ue = - 0.0113
-0.2 -0.15 -0.1 -0.05 0 0.05 0.1 0.15 0.2
-0.2 -0.15 -0.1 -0.05 0 0.05 0.1 0.15 0.2
x1
x2
saddle point
stable equilibrium point
saddle point
x1 ' = ( - 25747/15000 sin(39/25 atan(1189714682109441/35184372088832 x1 + 1189714682109441/35184372088832 atan(6/5 x2/v cos(x1)) - 1189714682109441/35184372088832 ue - 1999/1000 atan(451/40 x1 + 451/40 atan(6/5 x2/v cos(x1)) - 451/40 ue))) - 17497/15000 sin(39/25 atan(3658850635097841/70368744177664 x1 - 3658850635097841/70368744177664 atan(13/10 x2/v cos(x1)) - 4477/2500 atan(18631/1000 x1 - 18631/1000 atan(13/10 x2/v cos(x1))))))/v - x2 x2 ' = ( - 25747/25000 sin(39/25 atan(1189714682109441/35184372088832 x1 + 1189714682109441/35184372088832 atan(6/5 x2/v cos(x1)) - 1189714682109441/35184372088832 ue - 1999/1000 atan(451/40 x1 + 451/40 atan(6/5 x2/v cos(x1)) - 451/40 ue))) + 227461/300000 sin(39/25 atan(3658850635097841/70368744177664 x1 - 3658850635097841/70368744177664 atan(13/10 x2/v cos(x1)) - 4477/2500 atan(18631/1000 x1 - 18631/1000 atan(13/10 x2/v cos(x1)))))) cos(x1)v = 25
ue = - 0.0114
-0.2 -0.15 -0.1 -0.05 0 0.05 0.1 0.15 0.2
-0.2 -0.15 -0.1 -0.05 0 0.05 0.1 0.15 0.2
x1
x2
saddle point
圖 3.6 系統狀態軌跡(低摩擦力路面)圖
(a) f 0.0113
rad(b) f 0.0114
rad
rad (rad)
rad (rad)
x1 ' = ( - 25747/15000 sin(39/25 atan(1189714682109441/35184372088832 x1 + 1189714682109441/35184372088832 atan(6/5 x2/v cos(x1)) - 1189714682109441/35184372088832 ue - 1999/1000 atan(451/40 x1 + 451/40 atan(6/5 x2/v cos(x1)) - 451/40 ue))) - 17497/15000 sin(39/25 atan(3658850635097841/70368744177664 x1 - 3658850635097841/70368744177664 atan(13/10 x2/v cos(x1)) - 4477/2500 atan(18631/1000 x1 - 18631/1000 atan(13/10 x2/v cos(x1))))))/v - x2 x2 ' = ( - 25747/25000 sin(39/25 atan(1189714682109441/35184372088832 x1 + 1189714682109441/35184372088832 atan(6/5 x2/v cos(x1)) - 1189714682109441/35184372088832 ue - 1999/1000 atan(451/40 x1 + 451/40 atan(6/5 x2/v cos(x1)) - 451/40 ue))) + 227461/300000 sin(39/25 atan(3658850635097841/70368744177664 x1 - 3658850635097841/70368744177664 atan(13/10 x2/v cos(x1)) - 4477/2500 atan(18631/1000 x1 - 18631/1000 atan(13/10 x2/v cos(x1)))))) cos(x1)v = 25
ue = - 0.01135068635
-0.2 -0.15 -0.1 -0.05 0 0.05 0.1 0.15 0.2
-0.2 -0.15 -0.1 -0.05 0 0.05 0.1 0.15 0.2
x1
x2
saddle point
saddle-node bifurcation point
圖 3.7 系統分歧點圖
圖 3.8 系統分歧點特性
rad (rad)
rad f -0.01135068635
- 0 .0 6 - 0 .0 4 - 0 .0 2 0 0 .0 2 0 .0 4 0 .0 6 - 0 .2
- 0 .1 5 - 0 .1 - 0 .0 5 0 0 .0 5 0 .1 0 .1 5
- 0 .0 6 - 0 .0 4 - 0 .0 2 0 0 .0 2 0 .0 4 0 .0 6
- 0 .1 - 0 .0 8 - 0 .0 6 - 0 .0 4 - 0 .0 2 0 0 .0 2 0 .0 4 0 .0 6 0 .0 8 0 .1
圖 3.9 v25m/s之分歧圖
radf
(rad)
radf (rad)
-0 .0 6 -0 .0 4 -0 .0 2 0 0 .0 2 0 .0 4 0 .0 6 -0 .2
-0 .1 5 -0 .1 -0 .0 5 0 0 .0 5 0 .1 0 .1 5
v= 4 0 m / s v= 3 0 m / s
v= 2 0 m / s v= 1 5 m / s
v= 2 5 m / s v= 1 0 m / s
v= 3 5 m / s
-0 .0 6 -0 .0 4 -0 .0 2 0 0 .0 2 0 .0 4 0 .0 6
-0 .2 5 -0 .2 -0 .1 5 -0 .1 -0 .0 5 0 0 .0 5 0 .1 0 .1 5 0 .2 0 .2 5
v= 1 0 m / s v= 1 5 m / s
v= 2 0 m / s v= 2 5 m / s
v= 3 0 m / s
v= 3 5 m / s v= 4 0 m / s
圖 3.10 各速度下之分歧圖
1 0 1 5 2 0 2 5 3 0 3 5 4 0
- 0 . 0 6 - 0 . 0 4 - 0 . 0 2 0 0 . 0 2 0 . 0 4 0 . 0 6
v ( m / s )
f (rad)
圖 3.11 v10~40
m/s
下轉向角度之穩定範圍(rad)
radf
radf (rad)
-0 .0 6 -0 .0 4 -0 .0 2 0 0 .0 2 0 .0 4 0 .0 6 -0 .2 5
-0 .2 -0 .1 5 -0 .1 -0 .0 5 0 0 .0 5 0 .1 0 .1 5 0 .2 0 .2 5
高 摩 擦 力 路 面
-0 .0 6 -0 .0 4 -0 .0 2 0 0 .0 2 0 .0 4 0 .0 6
-0 .4 -0 .3 -0 .2 -0 .1 0 0 .1 0 .2 0 .3 0 .4
圖 3.12 v25m/s下高低摩擦力路面之分歧圖
radf
(rad)
radf (rad)
圖 3.13 相同輸入下,高低摩擦力路面與之比較圖
10 15 20 25 30 35 40
-0.2 -0.15 -0.1 -0.05 0 0.05 0.1 0.15 0.2
v (m/s)
f (rad)
low friction load high friction load
圖 3.14 高低摩擦力路面之最大安全轉向角度範圍比較圖
第四章
車輛轉向系統連續時間控制器設計
回顧本論文第三章,我們由相平面分析及數值模擬與穩定性 分析 得知,當車輛速度過快或輸入超過最大安全轉向 角度範圍時,系統會 發生鞍節點分歧現象,使得系統無一穩定的節點,因而將導致系統本 身不穩定;若不施加適當控制補償,車輛很容易失控,甚而翻覆。在 文獻[12]中,作者成功地提出以回授線性化控制來解決此一導致系統不 穩定之現象。然而,回授線性化控制為一非線性時變控制法則 (請參 考第二章 2.1 節之推導),需要大量複雜的數值計算。因此,在計算複 雜度考量下,實有必要發展一較簡易但有效之新型控制器 。本論文延 續[12]中之結果,進一步提出一“非時變回授線性化控制”設計方法,
嘗試將回授線性化控制之時變控制值改 以一固定之增益值,並利用此 一簡化控制來控制車輛轉向系統之連續模型。另外,在傳統回授線性 化控制中存在一固定增益之 參數設計問題(詳見第二章 2.1 節之說 明),本章中將提出如何最佳設計此一參數值 。
在 4.1 節中,我們首先提出車輛轉向系統之一線性模型。在 4.2 節 中,我們依據所推導之線性化模型並仿照第二章 2.1 節回授線性化控制 設計方法,提出一非時變回授線性化控制。在 4.3 節中,我們針對車輛