基于labVIEW的雙輪自平衡小車概要

1、雙輪自平衡小車摘要：本系統(tǒng)主要包括控制系統(tǒng)模塊、電機驅(qū)動模塊和角速度測量模塊三個模塊，根據(jù)角加速度傳感器測量出的數(shù)據(jù)，利用myRIO調(diào)節(jié)占空比，調(diào)節(jié)電機的轉(zhuǎn)速，使小車能始終保持平衡。關鍵詞：PID控制，PWM自平衡；目錄1方案分析11.1 模塊方案比較與選擇11.2 總體方案論述12電路與硬件設計2.2.1 .驅(qū)動的選擇22.2 電路設計錯誤！未定義書簽。3_統(tǒng)軟件設計43.1 控制算法的選取43.2 程序流程圖73.3 程序1t單104系統(tǒng)測試及結果分析13總結15參考文獻15附錄實物圖表16一、方案分析1.1. 模塊方案比較與選擇1.1.1 控制系統(tǒng)模塊的論證與選擇方案一：采用傳統(tǒng)的89C

2、51芯片為控制核心。具有4KB的程序存儲器，128KB的數(shù)據(jù)存儲器，64KB的片外存儲器尋址能力，64KB的片外數(shù)據(jù)存儲器尋址能力，32根/入/輸出線，1個全雙工異步用行口，2個16位定時/計數(shù)器，5個中斷源，2個優(yōu)先級。但數(shù)學處理能力差，功能單一，運算速度慢，控制過程比較煩瑣。方案二：采用采用NImyRIO。NImyRIO內(nèi)嵌XilinxZynq芯片,使學生可以利用雙核ARMCortex-A9的實時性能以及強大的計算功能，編程開發(fā)簡單，支持用LabVIEW進行編程，圖形編程，明了易懂，同時包含大量現(xiàn)成算法函數(shù)，方便快速調(diào)用。同時，myRIO自帶三軸加速度傳感器，可通過LabVIEW觀察波形，

3、進行自平衡小車測量時非常方便。綜合考慮采用方案二控制。1.1.2 電機驅(qū)動模塊的論證與選擇萬案一：采用步進電機為驅(qū)動源，但步進電機并不能像普通的直流電機，交流電機在常規(guī)下使用。它必須由雙環(huán)形脈沖信號、功率驅(qū)動電路等組成控制系統(tǒng)方可使用。且速度不是很快，不好操作。萬案一：使用MOSFET構成H橋式驅(qū)動電路，利用PWM波形來控制電機的轉(zhuǎn)速,18此電路驅(qū)動功率比較大耗能高，電機的轉(zhuǎn)速較快。方案二:使用直流電機驅(qū)動芯片L298N來驅(qū)動直流電機，通過占空比來調(diào)節(jié)轉(zhuǎn)速,控制較為方便。綜合考慮采用方案三1.1.3 角速度測量模塊的論證與選擇方案一：使用三軸加速度傳感器MMA7260Q可以測量小車加速度大小，

4、選取最佳重心位置，將測量出的數(shù)據(jù)傳入控制系統(tǒng)。萬案一：使用myRIO自帶三軸加速度傳感器，由于是本身自帶，便于使用與測量。1.2. 總體方案論述本系統(tǒng)主要包括控制系統(tǒng)模塊、電機驅(qū)動模塊和角速度測量模塊三個模塊，根據(jù)角加速度傳感器測量出的數(shù)據(jù)，利用myRIO調(diào)節(jié)占空比，調(diào)節(jié)電機的轉(zhuǎn)速,使小車能始終保持平衡。二、電路與硬件設計2.1. 驅(qū)動的選擇本電路選擇TB6612FN斯型驅(qū)動器件，與傳統(tǒng)電動機驅(qū)動相比，具有較高的集成度，且能獨立雙向控制2個直流電機，同時能提供足夠的輸出能力，運行性能和能耗方面也具有優(yōu)勢，因此在集成化、小型化的電機控制系統(tǒng)中，它可以作為理想的電機驅(qū)動器件。它具有大電流MOSFE

5、T-橋結構，雙通道電路/U出，可同時驅(qū)動2個電機，TB6612FNG®通道輸出最高1.2A的連續(xù)驅(qū)動電流，啟動峰值電流達2A/3.2A(連續(xù)脈沖/單脈沖);4種電機控制模式：正轉(zhuǎn)/反轉(zhuǎn)/制動/停止;PWMJ持頻率高達100kHz;待機狀態(tài)；片內(nèi)低壓檢測電路與熱停機保護電路；工作溫度：-2085C;SSOP24、型貼片封裝。AIN1/AIN2、BIN1/BIN2、PWMA/PWMB為控制信號輸入端；AO1/A02、B01/B02為2路電機控制輸出端；STBY為正常工作/待機狀態(tài)控制引腳；VM(4.515V)和VCC(2.75.5V)分別為電機驅(qū)動電壓輸入和邏輯電平輸入端。工叵0區(qū)田叵E

6、叵叵回叵回1* %* 14 2 2 Ti 7* 2 1 1-OODDOOOODDOOaannaarbnnb bG G G Gp p p pS2 1 Y 12B NNCBDNWM3 11c TNIIWM 用 haavsgbrpm圖1芯片引腳功能配置圖2.2. 電路設計TB6612FNG與AVR單片機組成的電機控制單元。單片機定時器產(chǎn)生4路PWM輸出作為AIN1/AIN2和BIN1/BIN2控制信號，對電機M1和M2的控制。使用功率MOSFET對VM和VCC提供電源反接保護。我們可以直接將PWM勺AB端口都接在MyRio的PWMJ出端口相連，使小車的兩個電機轉(zhuǎn)速均由同一個量進行控制，小車的轉(zhuǎn)動能同

7、步。兩且個電機的轉(zhuǎn)動方向控制也由MyRio輸出進行控制，同步進行方向的轉(zhuǎn)換，使小車在偏移后達到平衡。vccoI/OOCxAOCxBI/OOCxA OC.xB I/O21222317 K IT19MCUIffGNi)GNDGND9IO201837AIN1A1N2PWWABINI BIN2 PWMRSTBYVCC GND PGND1 PC NTH PGND2 PG ND 2AO 2A02BO 2BO 2BOIBOLVM1VM2VMSTB6612FNGMl6AOIAOIM2M1112IfCNDGND241314圖2電機控制單兀My Rio電源輸入電路：通過外接開關開關和插口，設計電路，將 My Ri

8、o由電源供電改為電池供電， 并可以實時的將控制器件進行開關。P指數(shù)的輸入和電機開關控制電路：外接軸轉(zhuǎn)式電位器，通過電阻分壓后接入 My Rio模擬端口，來控制P指數(shù) 的變化，并且外接開關通過輸入的 0、1,改變程序來控制電機的轉(zhuǎn)和停，達到 實時控制，利于調(diào)制程序。三、系統(tǒng)軟件設計3.1 控制算法的選取本系統(tǒng)的控制算法選用PID算法3.1.1 PID概述PID調(diào)節(jié)器是指按偏差的比例、積分和微分進行控制的調(diào)節(jié)器，其調(diào)節(jié)實質(zhì)是根據(jù)輸入的偏差值，按比例、積分、微分的函數(shù)關系進行運算，其運算結果用于輸出控制。在實際應用中，在多數(shù)情況下，根據(jù)具體情況，可以靈活地改變PID的結構，取其一部分進行控制(楊德剛

9、等，2010)。PID控制器的輸入輸出關系為：u(t)=KP&t)Ki0e(t)dtKd哼dt(15)PID控制有模擬和數(shù)字控制方式：模擬方式采用電子電路調(diào)節(jié)器，在調(diào)節(jié)器中，將被測信號與給定值比較，然后把比較出的差值經(jīng)PID電路運算后送到執(zhí)行機構，改變給進量，達到調(diào)節(jié)之目的。數(shù)字方式用計算機進行PID運算，將計算結果轉(zhuǎn)換成模擬量，輸出去控制執(zhí)行機構。本設計選用數(shù)字PID控制方式。比例控制對系統(tǒng)動態(tài)性能的影響：Kp增大時，將使系統(tǒng)響應速度加快，Kp偏大時，系統(tǒng)振蕩次數(shù)增多，調(diào)節(jié)時間加長；&偏小時，系統(tǒng)響應速度緩慢。Kp選擇以輸出響應產(chǎn)生4:1衰減過程為宜。在系統(tǒng)穩(wěn)定的前提下，加大

10、Kp可以減少穩(wěn)態(tài)誤差，但不能消除穩(wěn)態(tài)誤差。積分時間Ti對系統(tǒng)性能的影響：積分控制通常影響系統(tǒng)的穩(wěn)定性。Ti太小使，系統(tǒng)不穩(wěn)定，且震蕩次數(shù)較多；Ti太大時，對系統(tǒng)的影響將削弱；Ti合適時，系統(tǒng)的過度過程特性比較理性。積分控制有助于消除系統(tǒng)穩(wěn)態(tài)誤差。微分時間TD對系統(tǒng)性能的影響：微分作用的增強可以改善系統(tǒng)動態(tài)特性，如減少超調(diào)量，縮短調(diào)節(jié)時間等，適當加大比例控制，可以減少穩(wěn)態(tài)誤差，提高控制精度；另一方面微分作用會放大系統(tǒng)噪聲，降低系統(tǒng)抗干擾能力。微分環(huán)節(jié)的加入可以在誤差出現(xiàn)或變化瞬間，按偏差的變化的趨勢進行控制。引進一個早期的修正作用，有助于提高系統(tǒng)穩(wěn)定性。3.1.2 數(shù)字PID算法數(shù)字PID算法為

11、用計算機實現(xiàn)，用數(shù)值逼近和連續(xù)信號離散化實現(xiàn)的PID控制規(guī)律。有兩種實現(xiàn)方式：位置性數(shù)字PID、增量型數(shù)字PID。3.1.2.1 位置式PID控制算式在采樣時刻t=k8(8為采樣周期)時，式(41)表示的PID控制規(guī)律可以通過以下數(shù)值公式近似計算:比例作用：*)= Kce(k)(4-2)積分作用:KC kU(k) C，e(i)Tli 0(4-3)微分作用:必陰=KCTDe(k)-e(k-1)6(4-4)式(42)、式(43)、式(44)表示的控制算法提供了執(zhí)行機構的位置u(k),所以稱為位置式PID控制算法，實際的位置PID控制器輸出為比例作用、積分作用與微分作用之和，即ukTD(4-5)u(

12、k)=up(k)ui(k)Ud(k)=KCe(k)-e(i)e(k)-e(k-1)TIi=071如果采樣周期8取得足夠小，這種逼近可相當準確，被控過程與連續(xù)控制過程十分接近。這種算法的缺點是，由于全量輸出，所以每次輸出均與過去的狀態(tài)有關，計算時要對e(k)進行累加，計算機運算工作量大。而且，因為計算機輸出的u(k)對應的是執(zhí)行機構的實際位置，如計算機出現(xiàn)故障，u(k)的大幅度變化，會引起執(zhí)行機構位置的大幅度變化，這種情況往往是生產(chǎn)實踐中不允許的。因而產(chǎn)生了增量式PID控制算式。位置式PID控制算式的系統(tǒng)控制示意圖如圖(4-2)所示。3.1.2.2 增量式PID控制算式增量式PID控制算式是指數(shù)

13、字控制器的輸出只是控制器的增量Au(k)0當執(zhí)行機構需要的是控制量的增量時，可由式(4-5)導出提供增量的PID控制算式。根據(jù)遞推原理可得：1kltu(k-1)=Kce(k-1)'、e(i)TDe(k-1)-e(k-2)Tit(4-6)用式(4-5)減去式(4-6)可得：u(k)=u(k)-u(k-1)-Td=Kce(k)e(k-1)e(k)-De(k)-2e(k-1)e(k-2)Ti(4-7)式(4-7)稱為增量式PID控制算式?？梢钥闯?，由于一般計算機控制系統(tǒng)采用恒定的采樣周期9,一旦確定了Kp、Ki、Kd,只要使用前后3次測量值的偏差，即可由式(4-7)求出控制增量。圖(4-3)

14、給出了增量式PID控制系統(tǒng)的示意圖。圖4-3增量式FIT控制系統(tǒng)框圖就整個系統(tǒng)而言，位置式與增量式控制算法并無本質(zhì)區(qū)別，增量式控制雖然只是算法上作了一點改進，卻帶來了不少優(yōu)點：(1) (1)由于計算機輸出增量，所以誤動作時影響小，必要時可以用邏輯判斷的方法去掉。(2) (2)手動/自動切換時沖擊小，便于無擾動切換。止匕外，當計算機發(fā)生故障時，由于輸出通道或執(zhí)行裝置具有信號的鎖存作用，故能仍然保持原值。(3) (3)算式中不需要累加。控制增量Au(k)的確定僅與最近k次的采樣值有關，所以較容易通過加權處理而獲得比較好的控制效果。但是增量式控制也有不足之處，積分截斷效應大，有靜態(tài)誤差，溢出的影響大

15、。因此，在選擇時不可一概而論。由于對增量式PID使用上的不熟悉，以及本品采用myRIO自帶的三軸加速度傳感器，可以將一個位置上的重力加速度值通過數(shù)學計算換算成地面與myRIO的位置角度關系，所以本設計選用位置式PID算法。3.1.3PID控制器PID (DBLyvi本系統(tǒng)采用labVIEW自帶的PID控制模塊，此模塊共包括六個輸入?yún)?shù)和兩個輸出參數(shù)。六個輸入?yún)?shù)分別是outputrange（輸出范圍）、setpoint（目標值）、processvariable（輸入量）、PIDgains（P、I、D參數(shù)輸入量）、dt（測量周期）、reinitialize（頻率值），兩個輸出參數(shù)分別是outpu

16、t（輸出值），dtout（輸出顯示周期）。pgoutputdt out (s)outputrangesetpointvariablePIDgainsdtreinitialize?(F)labVIEW中的PID子vi3.2 程序流程圖3.2.1 主程序流程圖加速度傳感器z軸輸出系統(tǒng)主程序流程框圖3.2.1加速度檢測部分流程圖加速度檢測部分流程框圖3.2.2PID中P參數(shù)調(diào)節(jié)器部分流程圖PID中P參數(shù)調(diào)節(jié)器部分程序框圖3.3 程序清單3.3.1 頂層程序展示(D1H250IH4PWM矍I.卜相關模塊簡介:三軸加速度傳感器（共有X/Y/Z三軸，本系統(tǒng)只采用Z軸）DigitalOutputkA/WOO

17、 (Pin 11 A/DIO1 (Pin 13:數(shù)字輸出口（如圖使用的是A區(qū)的0和1數(shù)字IO 口，分別為為pinll和pin13)PWM輸出口（本系統(tǒng)使用的是A區(qū)PWM0輸出口）選擇結構（通過輸入值的T/F選擇上/下值的輸出）:延遲（本例為延遲20ms）PID模塊（前文已介紹）:波形圖表（將輸出值以波形形式輸出）3.3.2 底層程序展示3.3.2.1加速度檢測部分程序相關模塊簡介:Rd口myRIOIOopen:myRIOIOread:myRIOIOclose數(shù)組索引3.3.2.1PIDP參數(shù)調(diào)節(jié)器部分程序相關模塊簡介:數(shù)值顯示3.3.2.1PIDP參數(shù)調(diào)節(jié)器部分程序相關模塊簡介:PID自帶濾波

18、:局部變量（此例為Z的局部變量）:數(shù)值輸入條件結構四、系統(tǒng)測試及結果分析本系統(tǒng)基本功能為能讓小車穩(wěn)定不倒在原地3秒以上，經(jīng)過兩天通宵調(diào)節(jié)，本系統(tǒng)能夠成功實現(xiàn)基本功能，但是根據(jù)地面條件的不同，相應的參數(shù)將會不同，例如，在砂紙上，由于摩擦力較大，所以P參數(shù)應相應減?。ń?jīng)實測P=3.2為最佳），否則將會由于比例過大而使小車回量過大而翻倒；在略光滑的地板（如創(chuàng)新實驗室地板）上，相應的P應加大（經(jīng)實測P=4.5為最佳），否則小車將沒有足夠的加速度而向前趴到。另外，本系統(tǒng)的拓展功能為能夠給小車一個角度，是小車向前行走一段距離并穩(wěn)定在地面上，但是由于對PID的不熟悉，屬于初次嘗試，所以拓展功能只在調(diào)解過程中的砂紙上成功過一次，而且對于I和D的使用完全沒有經(jīng)