簡易旋轉(zhuǎn)倒立擺及控制裝置-電子設(shè)計大賽論VIP

1、2013年全國大學(xué)生電子設(shè)計大賽論文C題簡易旋轉(zhuǎn)倒立擺及控制裝置【本科組】 2013/9/4目錄摘要.21.系統(tǒng)方案.2系統(tǒng)硬件結(jié)構(gòu)設(shè)計.2（1）直流減速電機2（2）編碼器3 1.2系統(tǒng)整體設(shè)計32. 系統(tǒng)設(shè)計與論證.3 2.1 微型控制器的選擇32.2 倒立擺框架的選擇設(shè)計53. 系統(tǒng)硬件電路設(shè)計.5 3.1供電系統(tǒng).53.2角度傳感器的設(shè)計.53.3電機及其驅(qū)動芯片的選擇與電路設(shè)計.64. 電路測試方法及測試結(jié)果7 4.1 一階倒立擺的PID控制實驗75 討論.86 參考文獻.97 附錄一 元器件清單.98 附錄二 部分源程序代碼.10摘要本題設(shè)計一個簡易旋轉(zhuǎn)倒立擺及控制裝置，系統(tǒng)以 IA

2、P15F2K61S2 芯片為控制核心，采用單片機、直流驅(qū)動器、直流減速電機、編碼器、倒立擺裝置等部分組成了一個閉環(huán)系統(tǒng)，通過PID調(diào)節(jié)實現(xiàn)對一階倒立擺的控制，使倒立擺這樣一個不穩(wěn)定的被控對象通過引入適當(dāng)?shù)目刂撇呗允怪蔀橐粋€能滿足各種性能指標(biāo)的穩(wěn)定系統(tǒng)。檢測角度的編碼器將輸入給它的角度量利用光電轉(zhuǎn)換原理轉(zhuǎn)換成相應(yīng)的電脈沖或數(shù)字量，并將該信號反饋給單片機，單片機接收到該信號后對該信號進行分析通過程序?qū)Φ沽[裝置產(chǎn)生控制。關(guān)鍵字 芯片、編碼器、反饋、PID控制系統(tǒng)方案系統(tǒng)硬件結(jié)構(gòu)設(shè)計將直流減速電機固定在木制支架上，圖示：系統(tǒng)硬件基本構(gòu)成并將旋轉(zhuǎn)臂通過螺絲固定在電機轉(zhuǎn)軸上，在旋轉(zhuǎn)臂的一端將擺桿通過轉(zhuǎn)

3、軸固定在旋轉(zhuǎn)軸上，其他如開關(guān)、穩(wěn)壓模塊、驅(qū)動模塊等合理布置在支架上，啟動電動機后，旋轉(zhuǎn)臂在電動機的驅(qū)動下做往復(fù)旋轉(zhuǎn)運動，帶動擺桿在垂直于旋轉(zhuǎn)臂的平面做自由旋轉(zhuǎn)，通過軟件來控制擺桿的運動狀態(tài)。 1）直流減速電機該電機型號為：德國馮哈勃Faulhaber帶編碼器空心杯減速電機2342L012。工作電壓：12伏。 空載轉(zhuǎn)速：8100轉(zhuǎn)/分鐘 。減速后速：120轉(zhuǎn)/分鐘。 輸出功率：17W。 扭矩 ：大扭矩（1.72Nm）。 圖示：直流減速電機減速比：64:1。 編碼器：光電式。該電動機的突出優(yōu)點是能在很大的范圍內(nèi)具有平滑平穩(wěn)的調(diào)速性能、啟動性能好、力矩大、控制簡單、過載能力超強、收電磁干擾影響小。工

4、作電壓: 12V空載轉(zhuǎn)速：8100RPM（轉(zhuǎn)每分鐘）減速后速：120RPM（轉(zhuǎn)每分鐘）直徑：30mm電機長度：42mm總共長度：85mm出軸直徑：6mm出軸長度：35mm輸出功率：17W扭矩：大扭矩( 1.72Nm)空載電流：75mA堵轉(zhuǎn)電流：1400mA減速箱型號：日本定制（全金屬精密行星減速箱）減速比：64：1編碼器：光電式輸出路數(shù)：雙路輸出每圈脈沖：12CPR（脈沖每圈）可以改裝其他高分辨率的光電編碼器型號：德國馮哈勃Faulhaber帶編碼器空心杯減速電機2342L012 12V每分鐘 120轉(zhuǎn)型號：德國馮哈勃Faulhaber帶編碼器空心杯減速電機2342L012 12V每分鐘 12

5、0轉(zhuǎn)2）編碼器編碼器是一種角度檢測裝置，它將輸入給軸的角度量利用光電轉(zhuǎn)換原理轉(zhuǎn)換成相應(yīng)的電脈沖或數(shù)字量，它具有體積小，精度高，工作可靠，接口數(shù)字化等特點。1.2系統(tǒng)整體設(shè)計 單片機通過角度傳感器檢測擺桿的運行狀態(tài)等相關(guān)參量并分析反饋信號，從而控制電機轉(zhuǎn)向及轉(zhuǎn)速，使直流減速電機在電源帶動下產(chǎn)生驅(qū)動力使擺桿根據(jù)擺角的變化而在垂直于旋轉(zhuǎn)臂的平面運動，使擺桿達到動態(tài)倒立狀態(tài)。對直流減速電機我們使用專用芯片L298N，保證了驅(qū)動的可靠性和精確性。擺桿直流減速電機光電碼盤1直流驅(qū)動器數(shù)據(jù)采集卡計算機 圖示：系統(tǒng)整體2.系統(tǒng)設(shè)計與論證2.1 微型控制器的選擇控制器的設(shè)計是倒立擺系統(tǒng)的核心內(nèi)容，因為倒立擺是一

6、個絕對不穩(wěn)定的系統(tǒng)，為使其保持穩(wěn)定并可以承受一定的干擾，需要給系統(tǒng)設(shè)計控制器，目前典型的控制器設(shè)計理論有：PID控制、根軌跡以及頻率響應(yīng)法、狀態(tài)空間法、最優(yōu)控制理論、模糊控制理論、神經(jīng)網(wǎng)絡(luò)控制、擬人智能控制、魯棒控制方法、自適應(yīng)控制、以及這些控制理論的相互結(jié)合組成更加強大的控制算法。本系統(tǒng)采用PID控制，比例控制(P)比例控制是一種最簡單的控制方式。其控制器的輸入與輸出誤差信號成比例關(guān)系。當(dāng)僅有比例控制時系統(tǒng)輸出存在穩(wěn)態(tài)誤差（Steady-state error）。積分控制（I）在積分控制中，控制器的輸出與輸入誤差信號的積分成正比關(guān)系。對一個自動控制系統(tǒng)，如果在進圖示：PID控制入穩(wěn)態(tài)后存在穩(wěn)

7、態(tài)誤差，則成這個系統(tǒng)是有穩(wěn)態(tài)誤差的或簡稱有差系統(tǒng)（System with Steady-state Error）。為了消除穩(wěn)態(tài)誤差，在控制器中必須引入“積分項”。積分項對誤差取決于時間的積分，隨著時間的增加，積分項會增大。這樣，即使誤差很小，積分項也會隨著時間的增加而增加，它推動控制器的輸出增大使穩(wěn)態(tài)誤差進一步減小，直到等于零。因此，比例+積分控制器可以使系統(tǒng)在進入穩(wěn)態(tài)后無穩(wěn)態(tài)誤差。 3)微分控制（D）在微分控制中，控制器的輸入與輸出誤差信號的微分（即誤差的變化率）成正比關(guān)系。自動控系統(tǒng)在克服誤差的調(diào)節(jié)過程中可能會出現(xiàn)振蕩甚至失穩(wěn)。其原因是由于存在有較大的慣性組件或有滯后組件，具有抑制誤差的作

8、用，其變化總是落后與誤差的變化，解決的辦法是使抑制誤差的作用的變化“超前”，即在誤差接近零時，抑制誤差的作用就應(yīng)該是零。這就是說，在控制器中引入“比例”往往是不夠的，比例項的中作用僅僅是放大誤差的幅值，而目前需要增加的是“微分項”，他不能預(yù)測誤差變化的趨勢，這樣，具有比例+微分的控制器就能夠提前使抑制誤差的控制作用等于零，甚至為負，從而避免了被控制的嚴(yán)重超調(diào)。所以對有較大慣性或滯后的被控對象，比例+微分控制器能改善系統(tǒng)在調(diào)節(jié)過程中的動態(tài)特性。 2.2 倒立擺框架的選擇與設(shè)計本設(shè)計要求倒立擺的穩(wěn)定性、精確性、快速性和平衡能力較高，因此，以木板作為底座，保證結(jié)構(gòu)的穩(wěn)定性，以鋼質(zhì)軌道作為旋轉(zhuǎn)臂，將直

9、流伺服電機固定在木制支架上側(cè)接擺桿，帶動擺桿在旋轉(zhuǎn)臂上運動，保證控制的精確性和快速性。直流伺服電機產(chǎn)生的驅(qū)動力根據(jù)擺桿的擺角的變化而在旋轉(zhuǎn)臂上轉(zhuǎn)動，使擺桿在豎直平面內(nèi)擺動并達到動態(tài)倒立狀態(tài)。3.系統(tǒng)硬件電路設(shè)計 3.1供電系統(tǒng)本系統(tǒng)采用 12 伏電壓給伺服電動機供電，配有5伏穩(wěn)壓模塊給單片機和角度傳感器供電。圖示:穩(wěn)壓電路3.2角度傳感器的設(shè)計我們選擇單圈的10K 精密電位器 它具有線性度好、易于調(diào)整阻值、可以在0-360 范圍內(nèi)周而復(fù)始的旋轉(zhuǎn)等特點，電位器旋轉(zhuǎn)到每一角度對應(yīng)一定的阻值，電位器接基準(zhǔn)的2.5V電壓，通過單片機的ADC 轉(zhuǎn)換為角度值。擺桿通過精密電位器與滑動模塊連接，滑動模塊在一

10、定范圍能滑動時，使擺桿可以在豎直平面內(nèi)上下左右擺動。 圖示：角度傳感器圖示：角度傳感器電路圖3.3 電機及其驅(qū)動芯片的選擇與電路設(shè)計由于倒立擺在運動過程中，對電機的快速性、穩(wěn)定性要求較高，且具有良好的啟動、制動和調(diào)速特性?？紤]到步進電機雖然具有良好的角度控制能力，但快速性達不到要求，被排除掉。普通直流機雖然能夠?qū)崿F(xiàn)快速啟動和制動，但調(diào)速性能較差。直流減速電機具有良好的啟動、制動和調(diào)速特性，可很方便的在寬范圍內(nèi)實現(xiàn)平滑無極調(diào)速，故選用直流減速電動機。 采用L298 電機驅(qū)動芯片。為防止電機工作時產(chǎn)生的噪聲對單片機的影響，在芯片與單片機的接口處添加兩個高速光耦芯片TLP521，這樣，單片機與電機就

11、在兩個完全獨立的電源下工作。使用高速光耦能保證單片機輸出的高頻率的PWM 控制信號可以無失真地輸出到 圖示：L298N子系統(tǒng)電路 L298N的輸入電路其中兩個端口控制電機的正反轉(zhuǎn)和停轉(zhuǎn)，使電機帶動滑動模塊在軌道上來回運動，其余一個端口輸出PWM 接在L298N 的使能端，控制電機的轉(zhuǎn)速，單片機的定時器的相位修正PWM 模式，可輸出高精度的PWM 波，實現(xiàn)對電機的精確控制。4. 電路測試方法及測試結(jié)果4.1 一階倒立擺的PID控制實驗 4、點擊運行程序，檢查電機是否上伺服。 5、記錄實驗結(jié)果。 6、改變PID參數(shù)再次記錄實驗結(jié)果。測試結(jié)果分析，系統(tǒng)總體上達到較好的性能。倒立擺能夠?qū)崿F(xiàn)動態(tài)倒立，且

12、運行的時間誤差在允許范圍內(nèi)。倒立擺運行性能較好，制作成本低，性價比較高。倒立擺控制的誤差主要來源于直流伺服電機、角度傳感器和倒立擺機械結(jié)構(gòu)。直流伺服電機在低速運動時，控制在死區(qū)，低脈寬時電機不運動。角度傳感器由精密電位器改制，存在角度死區(qū)，精度不足。導(dǎo)軌硬度不夠，滑動模塊長時間滑動造成導(dǎo)軌下彎，滑動模塊在運動中摩擦力不均勻。因此，采用具有更好啟動、制動和調(diào)速特性直流電機、精度更高的角度傳感器改進硬件結(jié)構(gòu)，以消除控制誤差，使控制精度更高。 5.討論 傳統(tǒng)的非線性系統(tǒng)分析方法需要非線性系統(tǒng)的精確模型，而現(xiàn)實世界上存在的大量復(fù)雜的多變的非線性系統(tǒng)則表現(xiàn)為參數(shù)的不確定性和結(jié)構(gòu)的不確定性。PID控制理論

13、為解決這類復(fù)雜多變量非線性系統(tǒng)開辟了一條新的途徑。本文圍繞一級倒立擺系統(tǒng)，采用自動控制理論中的經(jīng)典控制理論研究了倒立擺的控制問題。通過該系統(tǒng)的設(shè)計，也說明了PID控制系統(tǒng)的設(shè)計的一般步驟，提供了一套利用Matlab進行控制器設(shè)計的有效方法，對PID控制系統(tǒng)設(shè)計具有借鑒意義。對于具有非線性、多變量等特點的倒立擺系統(tǒng)進行系統(tǒng)分析，推到出其非線性數(shù)學(xué)模型，分析其非線性因素，擾動對倒立擺系統(tǒng)的影響。詳細敘述了以經(jīng)典控制理論為基礎(chǔ)的PID控制理論，針對倒立擺系統(tǒng)為控制對象設(shè)計了PID控制及相關(guān)的控制方法。以倒立擺擺角為被控量，PID控制器結(jié)構(gòu)簡單，實施性好。PID控制方法實現(xiàn)了倒立擺的良好控制。運用經(jīng)典

14、控制的基本理論和方法，即可實現(xiàn)對PID參數(shù)的最佳自動調(diào)整，這就是PID控制。通過實驗結(jié)果可知，這種控制方法可以實現(xiàn)良好的控制效果。在倒立擺系統(tǒng)仿真實驗的基礎(chǔ)上，實現(xiàn)了倒立擺的實物控制。將控制器嵌入到倒立擺控制中，進行編譯、連接、運行，實現(xiàn)對倒立的實時控制。但是由于參數(shù)選擇或個人原因還存在著誤差或缺點，可以通過多次系統(tǒng)的仿真進一步完善。6.參考文獻【1】郭天祥51單片機C語言教程電子工程出版社2009/01【2】康華光電子技術(shù)基礎(chǔ)模擬部分高等教育出版社2005/7【3】康華光電子技術(shù)基礎(chǔ)數(shù)字部分高等教育出版社2005/7【4】21ic中國電子網(wǎng)7附錄一 元器件清單1. 基本儀器清單60MHz雙通道數(shù)字示波器100MHz雙通道數(shù)字示波器低