基于卡爾曼濾波的平面倒立擺最優(yōu)控制研究.pdf

1、倒立擺是一種具有非線性、多變量、強(qiáng)耦合、欠驅(qū)動(dòng)、自不穩(wěn)定等特性的裝置，可以直觀反映控制理論中的穩(wěn)定性、可控性、魯棒性等許多關(guān)鍵問(wèn)題，是研究和驗(yàn)證各種控制算法有效性和正確性的典型平臺(tái)，其相關(guān)理論在機(jī)器人平穩(wěn)行走、工業(yè)過(guò)程控制、火箭垂直發(fā)射和衛(wèi)星飛行姿態(tài)控制等工程實(shí)踐中也得到了廣泛運(yùn)用和發(fā)展。
　　本文以平面倒立擺為研究對(duì)象，對(duì)平面二級(jí)倒立擺的穩(wěn)擺控制和平面一級(jí)倒立擺軌跡跟蹤控制進(jìn)行研究。平面二級(jí)倒立擺比平面一級(jí)倒立擺多一根擺桿，其控

2、制難度卻遠(yuǎn)大于平面一級(jí)倒立擺，因?yàn)樯舷聰[桿之間存在嚴(yán)重耦合，擺桿相關(guān)變量個(gè)數(shù)也比平面一級(jí)倒立擺多一倍。平面倒立擺實(shí)物還受到一定程度的噪聲干擾，尤其是平面二級(jí)倒立擺，其下擺桿角度檢測(cè)不精準(zhǔn)會(huì)直接影響上擺桿的穩(wěn)定性，且上擺桿的角度本身也存在測(cè)量噪聲；通過(guò)差分運(yùn)算時(shí)噪聲被放大，控制器的輸出不穩(wěn)定，又混入較大的過(guò)程噪聲，最終影響平面倒立擺的穩(wěn)定性。針對(duì)平面倒立擺強(qiáng)耦合、多變量和噪聲干擾的問(wèn)題，需要建立準(zhǔn)確的數(shù)學(xué)模型、設(shè)計(jì)可以優(yōu)化控制的控制器和抑

3、制噪聲干擾的濾波器。深入分析平面倒立擺，首先采用拉格朗日方程建立其非線性數(shù)學(xué)模型，在平衡位置附近線性化后，得到平面倒立擺正交方向上解耦的線性化數(shù)學(xué)模型，解決正交方向耦合的問(wèn)題；接著，運(yùn)用線性二次型最優(yōu)控制理論，設(shè)計(jì)平面倒立擺的LQR最優(yōu)控制器；然后，確定平面倒立擺的噪聲參數(shù)，設(shè)計(jì)滿足平面倒立擺實(shí)時(shí)性要求的穩(wěn)態(tài)卡爾曼濾波器，抑制噪聲對(duì)平面倒立擺的影響；最后，用基于穩(wěn)態(tài)卡爾曼濾波的LQR最優(yōu)控制器，實(shí)現(xiàn)了平面二級(jí)倒立擺的穩(wěn)擺控制和平面一級(jí)倒

4、立擺的軌跡跟蹤控制。實(shí)驗(yàn)結(jié)果表明，按照本文提出的方法設(shè)計(jì)的基于穩(wěn)態(tài)卡爾曼濾波的LQR最優(yōu)控制器能有效抑制噪聲干擾并優(yōu)化控制，提高了系統(tǒng)的穩(wěn)定性和魯棒性。
　　本研究創(chuàng)新點(diǎn)包括：⑴對(duì)平面倒立擺的研究背景及現(xiàn)狀進(jìn)行了系統(tǒng)地分析和闡述，在深入分析平面倒立擺的基礎(chǔ)上，采用拉格朗日方程建立平面一級(jí)、二級(jí)倒立擺的非線性數(shù)學(xué)模型，再在平衡位置附近運(yùn)用極限和無(wú)窮小定理進(jìn)行線性化處理，得到平面一級(jí)、二級(jí)倒立擺在正交方向上解耦的線性化狀態(tài)空間方程。區(qū)

5、別于文獻(xiàn)中其他研究者進(jìn)行線性化時(shí)采用復(fù)雜且計(jì)算量大的泰勒級(jí)數(shù)展開(kāi)的方法，本文采用了簡(jiǎn)單直觀的極限和無(wú)窮小定理的方法，簡(jiǎn)化了建模的過(guò)程。⑵提出了平面倒立擺的運(yùn)動(dòng)軌跡時(shí)間函數(shù)，設(shè)計(jì)了平面一級(jí)倒立擺基座小車(chē)定位優(yōu)先于擺桿鎮(zhèn)定的LQR最優(yōu)控制器，用MATLAB實(shí)現(xiàn)了平面一級(jí)倒立擺的軌跡跟蹤控制仿真；對(duì)于平面二級(jí)倒立擺，設(shè)計(jì)了擺桿鎮(zhèn)定優(yōu)先于基座小車(chē)定位的LQR最優(yōu)控制器，用MATLAB實(shí)現(xiàn)了平面二級(jí)倒立擺的穩(wěn)擺控制仿真。⑶基于大量平面倒立擺實(shí)時(shí)數(shù)