第五章 模擬結果
5.2. 平衡控制器效能驗證
在此節中,我們將驗證 4.2 節中所提出的平衡控制器確能讓旋轉式倒 單擺系統的單擺在向上垂直位置達到持續的平衡穩定。
以下將模擬三種 LQR 控制器,分別是:
線性非時變 LQR 控制器
線性時變 LQR(SDC)控制器
線性非時變 LQR 補償控制器
首先我們定義平衡控制器之有效工作範圍,如圖 5.3 所示,𝛼𝛼 = 180°− 𝜀𝜀,其中𝜀𝜀 ∈ [−𝜀𝜀𝑚𝑚𝑎𝑎𝑥𝑥, 𝜀𝜀𝑚𝑚𝑎𝑎𝑥𝑥]。
圖5.3 平衡控制器的有效工作範圍示意圖
接著,假設系統初始值為𝜃𝜃0 = 0及𝛼𝛼0 = 180°− 𝜀𝜀,及 LQR 設計參數如下:
1 ,
0 0 0 0
0 0 0 0
0 0 10 0
0 0 0 25
=
= R
Q (5.1)
45
5.2.1. 線性非時變 LQR 控制器效能驗證
在此節中,我們分別測試三種平衡控制器的工作範圍𝜀𝜀,分別是𝜀𝜀1 = 5°、𝜀𝜀2 = 16°以及𝜀𝜀3 = 17°。
圖5.4 線性非時變 LQR 控制器(𝜀𝜀1)之效能驗證
圖5.5 線性非時變 LQR 控制器(𝜀𝜀2)之效能驗證
46
圖5.6 線性非時變 LQR 控制器(𝜀𝜀3)之效能驗證
模擬中我們可求得旋轉式倒單擺系統之旋轉臂擺動角 θ、單擺擺動角 α 及控制輸入 u 之反應,並求得平衡控制器最大的有效工作範圍時,以 4 秒計算,控制器輸出總能量為 1025.3。如圖 5.4-5.6 所示,我們可清楚的 得知𝜀𝜀 ≤ 16°時,旋轉式倒單擺系統在施加適當平衡控制之情況下,單擺 擺動角𝛼𝛼之反應會平衡在向上垂直位置(𝛼𝛼 = 180°),且𝜀𝜀越小,所需要控 制輸入的 u 越小,旋轉臂擺動角θ及單擺擺動角𝛼𝛼也較為平滑。而當𝜀𝜀 > 16° 時,則超出平衡控制器的有效工作範圍,因此單擺擺動角𝛼𝛼無法平衡在向 上垂直位置。
47
5.2.2. 線性時變 LQR(SDC)控制器效能驗證
在此節中,我們同樣分別測試三種平衡控制器的工作範圍𝜀𝜀,分別是 𝜀𝜀1 = 5°、𝜀𝜀2 = 17°及𝜀𝜀3 = 18°。
模擬中我們可求得旋轉式倒單擺系統之旋轉臂擺動角 θ、單擺擺動角 α 及控制器輸出 u 之反應,並求得平衡控制器最大的有效工作範圍,並以 4 秒計算,控制器輸出總能量為 573.9。如圖 5.7-5.9 所示,我們可清楚的 得知𝜀𝜀 ≤ 17°時為平衡控制器的有效工作範圍內,因此施加適當平衡控制 u 之情況下,單擺會平衡在向上垂直位置。而當𝜀𝜀 > 18°時,則超出平衡 控制器的有效工作範圍,因此單擺擺動角𝛼𝛼無法持續平衡在向上垂直位 置。
圖5.7 線性時變 LQR(SDC)平衡控制器(𝜀𝜀1)之效能驗證
48
圖5.8 線性時變 LQR(SDC)平衡控制器(𝜀𝜀2)之效能驗證
圖5.9 線性時變 LQR(SDC)平衡控制器(𝜀𝜀3)之效能驗證
我們比較 5.2.1 節的線性非時變 LQR 控制器,從圖 5.4-5.9 所示,在 平衡控制器的有效工作範圍內,線性時變 LQR(SDC)控制器效能較佳、所
49
需的控制輸出 u 較小、單擺及旋轉臂的反應也較為平滑以及平衡時間也 較為快速,另外線性時變 LQR(SDC)控制器的有效工作範圍也較大。
5.2.3. 線性非時變 LQR 補償控制器效能驗證
在此節中,我們同樣也是分別測試三種平衡控制器的工作範圍𝜀𝜀,分 別是𝜀𝜀1 = 5°、𝜀𝜀2 = 16°及𝜀𝜀3 = 17°。
模擬中我們可求得旋轉式倒單擺系統之旋轉臂擺動角 θ、單擺擺動角 α 及控制器輸出 u 之反應,並求得平衡控制器最大的有效工作範圍,並以 4 秒計算,控制器輸出總能量為 1542.5。如圖 5.10-5.12 所示,其結果與 5.2.1 節的線性非時變 LQR 控制器相似,主要的原因可能在於 LQR 控制 器本身已有很好的控制效果,所以 LQR 再加上補償,其效過就不明顯,
反而增加了控制器輸出 u 的能量。
圖5.10 線性非時變 LQR 補償控制器(𝜀𝜀1)之效能驗證
50
圖5.11 線性非時變 LQR 補償控制器(𝜀𝜀2)之效能驗證
圖5.12 線性非時變 LQR 補償控制器(𝜀𝜀3)之效能驗證
51