簡單倒立擺建模

相信我們很多人都會遇到過建模倒立擺的情況。倒立擺是控制系統領域中一個很基本但又很實用的問題。很多基本的控制邏輯和實現都可以通過倒立擺模型表示出來。但是,在網上搜索資料良莠不齊,而去參考論文又晦澀難懂。所以,我自己經過推導和驗證,把一階倒立擺的模型給寫出來,供大家參考和學習。

杆重心的水平位置:

杆重心的豎直位置:

 

杆的水平受力:

杆的豎直受力分析:

杆的轉動方程:

小車的受力分析:

聯立後四個式子,得到動態方程:

在θ=0附近,可以線性化,sinθ=θ,cosθ=1

化簡得

寫成標準的系統形式

在不加控制u的情況下,特徵多項式

由於中,是正數,所以λ有值爲正數的根。因爲A並不所有的特徵值實部都小於0,所以系統是不穩定的。

 

同時,我們可以分析系統的可控性。如果系統是可控的,那麼令,若rank(C0 )=4,那麼系統就是可控的。

 

我們設A中 B中

那麼,可以推導得到,若rank(C0 )=4,則C0可逆,行列式不爲0

行列式

而且我們知道,所以等號不成立,所以行列式不爲0,系統可控。

而至於具體的控制算法,那就很多種多樣了,要用什麼樣的算法做控制,留作日後再繼續探討。

發表評論
所有評論
還沒有人評論,想成為第一個評論的人麼? 請在上方評論欄輸入並且點擊發布.
相關文章