爬樓梯的自行輪椅車設計

《爬樓梯的自行輪椅車設計》由會員分享，可在線閱讀，更多相關《爬樓梯的自行輪椅車設計（70頁珍藏版）》請在裝配圖網上搜索。

1、全套畢業(yè)設計CAD圖紙加 36296518 目錄 1 緒論 3 1.1 課題研究原因和意義 3 1.1.1　課題研究的原因 3 1.1.2　課題研究的意義 3 1.2 目前國內外研究狀況 3 1.2.1　輪組式 4 1.2.2　履帶式 5 1.2.3　腿式 6 1.2.4　復合式 6 1.3 目前研究中所存在問題 7 2 系統(tǒng)方案設計 9 2.1 系統(tǒng)方案確定 9 2.2智能電動越障爬樓輪椅系統(tǒng)構成 10 2.2.1底盤系統(tǒng) 10 2.2.2座椅姿態(tài)調整系統(tǒng) 15 2.2.3驅動控制系統(tǒng) 16 3 輪椅驅動模塊設計 18 3.1 電機的選擇 1

2、8 3.2 電機工作原理 20 3.3 電源的選擇 23 3.4控制核心C8051F020 23 3.4.1 C8051FO20概述 23 3.4.2主要性能參數 24 3.5電機轉速控制 25 3.5.1電機轉速控制原理 25 3.5.2電機轉速控制方案 26 3.6 電機驅動電路 27 4 系統(tǒng)控制方案設計 30 4. 1操縱桿設計 30 4. 2雙電機同步控制方案 32 4.2.1 并行控制 32 4.2.2 主從控制 33 5 輪椅車控制算法設計 35 5.1 速度檢測電路 35 5.2 PID控制方法 36 5.2.1 PID控制方法介紹

3、36 5.2.2 數字式增量PID控制算法 38 5.2.3 標準PID算法的改進 39 5.2.4 干擾的抑制 40 5.2.5 PID調節(jié)器的參數整定 40 6 輪椅車控制模塊的數學模型 43 6.1 系統(tǒng)運行方框圖 43 6.2系統(tǒng)運行原理 44 6.3建立數學模型 44 7 軟件實現 50 7.1 單片機片內的資源配置 50 7.1.1 單片機內各功能模塊配置 50 7.1.2 單片機的端口配置 51 7.2 程序模塊介紹 51 7.2.1 初始化模塊 51 7.2.2 測速子程序 53 7.2.3 主程序 56 7.3 總程序 58

4、 總結 67 參考文獻 68 致謝 69 全套圖紙加 36296518 1 緒論 1.1 課題研究原因和意義 1.1.1　課題研究的原因 現今，老齡化人群以和下肢殘障者在占我國總人口總數的比重愈來愈大，他們喪失了部分行動能力，更需要有人來加以幫助和護理。目前，在其中的很大一部分年老體弱者和下肢傷殘者會選擇輪椅作為他們的外出行動工具，而且大都需要在家人或護理人員下使用輪椅來進行活動。隨著現今社會的快速發(fā)展，城市化的不斷加快，樓梯和跨越路障等不斷增加。然而，對于普通輪椅而言是很難跨越這種障礙，

5、從而限制了輪椅使用者的活動范圍，影響其一系列的社交生活。尤其是國內城市樓房公寓，電梯并沒有應用到所有的居民住宅，這給輪椅乘坐者造成諸多不便。馬路沿、土坑等戶外障礙同樣對老年人、殘障人士的出行帶來了很多不便，影響了他們的正常生活。 1.1.2　課題研究的意義 為了解決弱勢群體人群增加而給社會經濟、醫(yī)療護理各方面帶來的巨大壓力，更好的關懷老年人、殘疾人的生活，改善他們的生活質量，除了加強改善房屋和各種公共建筑設施的無障礙設計，擴大輪椅的使用范圍之外，改進現有的普通輪椅，使其兼?zhèn)淦降匦旭傄约芭涝綐翘菡系K兩種功能，成為更行之有效、立竿見影的措施。值得注意的是，最近幾年突發(fā)性自然災害將導致肢體殘障者

6、的數量大幅上升。 大量災難幸存者急需輪椅等康復設備和輔助工具。因此，為了解決需求，給老年人和殘疾人士提供性能優(yōu)越的交通和輔助工具，解決樓梯或路障對他們生活造成的不便，同時在考慮使用者的經濟所承受能力限制，研究一種價格適宜、輕便的爬樓梯輪椅具有重大的現實意義和實用價值。 1.2 目前國內外研究狀況 在爬樓梯裝置的研究領域內，國外對爬樓梯裝置的研究開始得相對較早，最早的專利是1892 年美國的Bray 發(fā)明的爬樓梯輪椅。此后，各國紛紛開始投入此項研究，其中美國、英國、德國和日本占主導地位，技術相對比較成熟，且有一些產品己經投入市場使用。 國內的研究也在近一、二十年內取得了顯著成果，

7、近年來相關專利屢見不鮮，目前國內外現有的爬樓梯裝置和專利種類眾多，不同的爬樓梯裝置適用于不同的環(huán)境和條件，各有利弊。按照爬樓梯裝置爬樓執(zhí)行機構的類型，主要可歸結為輪組式、履帶式、腿式三類。 1.2.1　輪組式 輪組式的特點是每個輪組依照星形輪的方式進行運動：平地行駛時，各小輪繞各自軸線自轉；爬樓梯時，各小輪一起繞中心軸公轉。 美國發(fā)明家Dean Kamen 發(fā)明的IBOT （專利號：US6 , 443 , 250 BI ）是一種能自動調節(jié)重心的兩輪組式輪椅，是單輪組爬樓裝置中最具代表性的爬樓裝置之一。iBOT 不僅采用了比普通輪椅復雜的驅動結構，而且安裝了多個感知人― 輪椅重

8、心位置的陀螺儀，控制器根據陀螺儀的信號調整重心的位置，使輪椅能夠在不同路面和直立狀態(tài)下保持平衡。iBOT3000 己經獲得FDA 批準在歐美上市，售價相當于中高檔轎車的價格。如下圖所示: 圖1.1 ibot實物圖 內蒙古民族大學物理與機電學院的蘇和平等人借鑒了iBOT 的爬樓方式，采用星形輪系作為爬樓梯機構，設計了一種雙聯(lián)星形機構電動爬樓梯輪椅。改輪椅爬樓時需要人工輔助或者樓梯扶手的輔助支撐，使其能調整重心的位置，安全爬樓。如下圖1-2 和1-3所示 圖1-2 雙聯(lián)星形爬樓梯輪椅圖 圖1-

9、3 雙聯(lián)星形爬樓梯輪椅改進圖 圖1.4 雙聯(lián)行星輪內部傳遞圖 1.2.2　履帶式 履帶式爬樓梯裝置的原理類似于履帶裝甲運兵車或坦克，技術較成熟，操作簡單，行走時重心波動很小，對樓梯的形狀、尺寸適應性強。英國Baronmead 公司開發(fā)的一種電動輪椅車，底部是履帶式的傳動結構，可爬樓梯的最大坡度為35 度，上下樓梯速度為每分鐘15-20個臺階。法國Topchalr 公司生產的電動爬樓梯輪椅，它的底部有四個車輪供正常情況下平地運行使用，當遇到樓梯等特殊地形時，用戶通過適當操作將兩側的橡膠履帶緩緩放下至地面，然后把這四個車輪收起，依靠履帶無需旁

10、人輔助便能自動 完成爬樓等功能。如圖1-5所示 圖1.5 履帶式結構 1.2.3　腿式 早期的爬樓梯裝置一般都采用步行式，其爬樓梯執(zhí)行機構由鉸鏈桿件機構組成。上樓時先將負重抬高，再水平向前移動，如此重復這兩個過程直至爬完一段樓梯。步行式爬樓梯裝置模仿人類爬樓的動作，外觀可視為足式輪椅，采用多條機械腿交替升降、支撐座椅爬樓的原理。如圖1-6所示 圖1.6 步行式爬樓輪椅 1.2.4　復合式

11、 現今，爬樓裝置一個研究創(chuàng)新點是將上述的輪組、腿式、履帶機構相互結合，吸取各自的優(yōu)點。比較廣泛的組合思路有以下兩種：一是輪履、腿履復合。比如中國科學技術大學精密機械與精密儀器系研制的一種小型全自主多種移動方式相融合的復合式越障輪椅。二是采用了輪一履復合 如圖1-7所示和輪－腿一履帶復合 如圖1-8所示等結構。設計主要是依靠腿式機構來完成越障，以及履帶平穩(wěn)性和輪組的靈活性來達到功能的完整。 圖1.7 輪一履復合圖 圖1.8 輪－腿一履復合圖 1.3 目前研究中所存在問題 履帶式的缺點就是對樓梯邊緣施加的強壓力，不可避免的對樓梯沿有一定的損壞，不適合

12、大絕大多數室內樓梯。自重較大，平地行走時阻力較大，相對于其他結構，履帶式轉彎需要更大的動力，使用過程中噪聲很大。這些都限制了它在日常生活中的推廣，被接受程度低。 腿式爬樓裝置有最好的地形適應力，但承載重量較小，具有較大危險性，且重心偏高。運動相對比較平穩(wěn)，顛簸感輕微，但同時運行速度較緩。此外，該類型裝置對控制的要求較高，操作比較復雜，在平地行走時運動幅度不大，動作緩慢。 復合式爬樓裝置各種機構的復合也給控制方面提出了更高的要求，而且爬樓過程中的穩(wěn)定性、如何適應不同尺寸的樓梯、如何實現手動操作省力與省時的問題以及反向自鎖等問題

13、仍然存在。 綜上所述，國外在爬樓梯裝置方面的研究己經有一百多年的歷史，成果也較多，但是它們大多結構復雜、造價昂貴，遠遠超出了發(fā)展中國家人民的經濟承受能力。國內的研究相對較晚，雖然也誕生了很多專利，但由于受到體積、重量、穩(wěn)定性及安全性的限制，還沒有產品真正投入使用。由此可見，為了解決移動輪椅使用受限的問題，同時考慮到我國使用者的經濟承受能力，需要研究一種價格低廉、功能多樣的爬樓梯裝置。 本裝置作為面向老年人和殘疾人的服務型機構，作者認為其設計思想必須從以下幾個性能出發(fā)： ( 1 ）平地、樓梯兩用；( 2 ）平地行駛效率高，操作方便簡單；( 3 ）爬樓時重心波動緩和，穩(wěn)定性好；( 4 ）不平坦

14、地形下對系統(tǒng)的重心作適時調節(jié)，避免車體傾斜給使用者帶來恐懼；( 5 ）上下樓時符合日常運動習慣，避免反向上樓給乘坐者帶來不便；（6）輪椅結構盡量簡單，造價低廉。 為了滿足上述要求，本文給出了一種結構緊湊、爬樓重心波動較小、正面上樓的平地、樓梯兩用助行裝置，并對其控制部分進行了詳細的論述。 2 系統(tǒng)方案設計 2.1 系統(tǒng)方案確定 通過綜合分析，各機構特點如下表所示： 表2.1 爬樓機構特點總結 移動機構方式 輪式 履帶式 腿式 移動速度 快 較快 慢 越障能

15、力 差 一般 好 機構復雜程度 簡單 一般 復雜 能耗量 小 較小 大 機構控制難易程度 易 一般 復雜 本設計確定采用爬樓梯優(yōu)勢較強的輪式機構。本論文采用的行星輪式爬樓梯輪椅的整體結構,行星輪結構在前進過程中通過中心軸驅動中心輪帶動行星輪從而帶動輪椅前迸,通過翻轉電機帶動行星架實現爬樓梯動作。 該種結構的優(yōu)點有： (1)平順的行駛能力。輪椅小車在平地行駛時，由于其結構上的特點，任意時刻都有兩個小車輪接地，利用輪組的定軸輪系傳遞動力，使小車輪快速的前進，其效率與普通輪式驅動車輛相

16、同。當遇到可跨越的障礙時，輪組通過形星輪系翻滾前進。 (2)可靠的上下樓梯能力。輪椅小車上下樓梯時，小車輪驅動電機停止，形星輪減速器及蝸輪蝸桿式大減速比裝置形成自鎖功能，使輪輻電機驅動輪組翻滾時，輪組中心齒輪不轉動。這使得在上下樓梯過程中，小車輪不會發(fā)生滾動，使得運動方位的控制得到精確的保證。這一優(yōu)點對小車下樓梯控制尤其重要。 (3)控制方式容易實現。任意時刻輪椅車體左邊車輪組著地小車輪和右邊輪組著地小輪分別具有相同的轉速，這樣就能準確控制移動輪椅的行走狀態(tài)。 (4)由電動機調速控制器來實現輪椅的轉彎、直線前進、爬樓前進三個基本運動單元，所需的轉彎半徑即為車身寬度。 2.2智能電動越障

17、爬樓輪椅系統(tǒng)構成 智能電動越障爬樓輪椅從整體上可以分為電氣與機械兩個部分，機械部分主要由 底盤系統(tǒng)與座椅調節(jié)系統(tǒng)構成，電氣部分主要由底盤驅動控制系統(tǒng)與座椅姿態(tài)檢測調 整系統(tǒng)構成。該系統(tǒng)結構如圖2.1所示： 圖2.1智能電動越障爬樓輪椅系統(tǒng)結構圖 2.2.1底盤系統(tǒng) 爬樓底盤系統(tǒng)釆用了創(chuàng)星的行星輪機構作前輪驅動行走，萬向輪、引導輪作為后 輪輔助行走。該系統(tǒng)可實現平地行走和越障爬樓的功能，對崎嶇的路面具有較好的適應能力。 根據GBT 18029.23-2008,可知一般樓梯每階髙度為180 mm±5 mm,最小樓梯坡度為35°,容許誤差為(見下圖)。所有樓梯的梯級

18、突邊都在由兩個相距10 mm、傾斜角度與樓梯坡度相同的平行平面所形成的區(qū)域內。 圖2.2 標準樓梯結構圖 可畫出爬樓底盤運動效果如圖2.3所示： 圖2.3 爬樓底盤運動效果 下圖為行星輪系結構圖 圖2.4 行星輪系結構圖 行星輪結構由2K-H周轉輪系的演化結構來實現。下圖2.5是2K-H周轉輪系的 結構簡圖。 圖2.5 K-H周轉輪系的結構簡圖

19、 萬向輪由于受到輪胎直徑的影響，在水平作用力推動的情況下只能翻爬小于輪胎 半徑的臺階或樓梯。在翻越樓梯及障礙的過程中采用中.純的萬向輪結構不僅會產生阻力，而且在翻爬樓梯時會產生較大的沖擊。在使用創(chuàng)新的引導輪結構與萬向輪相配合后，輪椅在翻越的過程中，障礙物或樓梯的臺階將首先與引導輪相接觸，由引導輪引導障礙物或樓梯的臺階與萬向輪和接觸。這樣不僅有利于提高萬向輪的翻越能力，而且可以減少阻力與沖擊。 圖2.6 創(chuàng)新的引導輪結構 2.2.2座椅姿態(tài)調整系統(tǒng) 座椅姿態(tài)檢測采用雙軸傾角傳感器，實吋檢測座椅與水平面的姿態(tài)以保證乘坐者的安全。翻轉時輪椅與地面的支撐點，增加了乘坐齊的安全性與舒適性

20、，同時又使得行星輪在翻轉的過程中所需要的力矩減少，翻轉更加容易。 圖2.7 座椅姿態(tài)調整機構示意圖 2.2.3驅動控制系統(tǒng) 驅動控制系統(tǒng)主要由微處理器系統(tǒng)、控制手柄及按鍵系統(tǒng)、主驅動電機及其驅動電路、電池組組成。驅動控制系統(tǒng)的目的在于配合機械結構完成相應的執(zhí)行動作，保證輪椅的正常運行。電力驅動控制系統(tǒng)的效果圖如下: 圖2.8 電力驅動控制系統(tǒng)的效果圖 3 輪椅驅動模塊設計 3.1 電機的選擇 考慮到輪椅車的戶外使用條件,我們需要

21、選擇永勵直流電機。永勵直流電機根據有無機械換向裝置又分為有刷直流電機和無刷直流電機。 無刷直流電機有如下優(yōu)點： a) 電子換向來代替?zhèn)鹘y(tǒng)的機械換向，性能可靠、永無磨損、故障率低 b) 屬靜態(tài)電機，空載電流小； c) 效率高； d) 體積小。 固目前電動車大部分都采用無刷直流電機作為動力部分,且有很多相應的控制器。但其還有如下缺點： a) 低速起動時有輕微振動； 　　 b) 價格高，相應的控制器要求高，成本也高； 　　 c) 易形成共振； 而有刷電機的如下特性是無刷電機所不可比擬的： a) 變速平穩(wěn)，幾乎感覺不到振動； 　　 b) 溫升低，可靠性好； 　 c) 價

22、格低 基于有刷直流電機的平穩(wěn)可靠及低成本，本方案采用有刷直流電機。如果注意碳刷的保養(yǎng)，以及及時更換其使用性還是非常好的。通過查找相關資料，我選擇北京康鍵宜醫(yī)療器械有限公司的輪椅車專用電機DG-M4。其外形及參數如下： 圖3.1 DG-M4外形 表3.1 DG電機產品系列 表3.2 DG－M4電機參數 該電動機構由一個帶電磁離合器（剎車）

23、裝置的永磁電動機和帶一級直齒和一級蝸輪副傳動的全封閉齒輪箱組成；手推輪椅時，可以通過簡易操作手柄釋放花鍵來實現離合。通過計算行走電機與翻轉電機均可為DG-M4。通過對花鍵的操作即可實現手動與自動的切換，而蝸輪蝸桿傳動對于爬樓裝置來說，可以實現自鎖，這對爬樓這一動作提供了安全保障。 3.2 電機工作原理 永磁直流電機是用永久磁體來建立電機所需的磁場，無需另用電源進行勵磁。有刷電機的定子上安裝有固定的主磁極和電刷，轉子上安裝有電樞繞組和換向器。直流電源的電能通過電刷和換向器進入電樞繞組，產生電樞電流，電樞電流產生的磁場與主磁場相互作用產生電磁轉矩，使電機旋轉帶動負載。 下圖為電機的四個永磁體

24、磁極，排列在同一圓周上。 圖3.1 電機磁極排列 釹鐵硼是目前最好的永磁體材料，磁力非常強大、矯頑力很高，性能好的永磁電機多選用釹鐵硼做磁極。磁極固定在機殼內，機殼同時為電機提供磁路。 在下圖中用藍色的磁力線表示電機的磁路。 圖3.2 電機的磁路 永磁電機不需勵磁電流發(fā)熱較少，但機殼為防鐵粉污染多為密封，一般通過機殼外周多個散熱片進行散熱；端蓋板延伸到機殼外兼做機腳，整個構成電機的定子機座，通過機腳來安裝固定電機。 永磁

25、直流電機的轉子由轉子鐵芯，轉子繞組、換向器、轉軸構成。 電流通過電刷連接轉子繞組，四極電機一般有四組電刷，一同裝在刷架上，共同構成電刷組件。下圖顯示了轉子與電刷組件的相對位置。 圖3.3 轉子與電刷組件的相對位置 下圖為合上端蓋的永磁直流電機剖面圖 圖3.4 永磁直流電機剖面圖 3.3 電源的選擇 明顯電動輪椅車的電源為可充電式電池，選擇好電池也是輪椅車正常工作的先決條件之一。本次方案選擇一般電動車上使用的鉛蓄電池。鉛蓄電池的優(yōu)點是放電時電動勢較穩(wěn)定，電壓平穩(wěn)、使用溫度及使用電流范圍寬、能充放電數百個循環(huán)、貯存性能好（尤其適

26、于干式荷電貯存）、造價較低，因而應用廣泛。 鉛蓄電池原理如下： 　　把A、B兩塊鉛板插入硫酸溶液中，鉛與硫酸作用的結果，使A、B兩塊鉛板上形成硫酸鉛，溶液中也被硫酸鉛飽和，這是還沒有電勢，給蓄電池充電時，在兩極上發(fā)生的化學反應如下： 　　A;PbSO4+2H2O - 2e-→PbO2+H2SO4+2H+; 　　B:PbSO4+2e-→Pb+SO42-; 　　可以看出，充電后，A板上的PbO2成為正極， B板上Pb成為負極。放電時，兩極發(fā)生的反應如下： 　　正極：PbO2+H2SO4+2H+ -2e-→PbSO4+2H2O-2e-; 　　負極：Pb+SO42-→PbSO

27、4+2e-; 又電機的額定電壓為24V,固選用24V的鉛蓄電池組。其自帶充電模塊。 3.4控制核心C8051F020 3.4.1 C8051FO20概述 C8051FO20系列單片機是Cygnal公司新推出的一種混合信號系統(tǒng)級單片機。該系列單片機片內含CIP-51的CPU內核，它的指令系統(tǒng)與MCS-51完全兼容。其中的C8051F020 單片機含有64kB片內Flash程序存儲器，4352B的RAM、8個I／O端口共64根I／O口線、一個12位A／D轉換器和一個8位A／D轉換器以及一個雙12位D／A轉換器、2個比較器、5個16位通用定時器、5個捕捉／比較模塊的可編程計數／定時器陣列

28、、看門狗定時器、VDD監(jiān)視器和溫度傳感器等部分。C8051F020單片機支持雙時鐘，其工作電壓范圍為2.7-3.6V(端口I／O，RsT和JTAC引腳的耐壓為5V)。與以前的51系列單片機相比，C8051F020增添了許多功能，同時其可靠性和速度也有了很大提高。外形及引腳排列如圖所示： 圖3.5 C8051FO20外形及引腳排列 圖3.6 C8051FO20內部邏輯圖 3.4.2主要性能參數 C8051F02x 系列單片機是集成在一塊芯片上的混合信號系統(tǒng)級單片機。芯片上有 64 位數字 I/O 口（C8051F020/2

29、)或 32 位數字 I/O 口（C8051F021/3）。C8051F020 作為整個系統(tǒng)的控制部件，它具有以下特點[10,14]： l 高速、流水線結構的8051兼容的CIP-51內核（可達25MIPS）； l 全速、非侵入式的在系統(tǒng)調試接口（片內）； l 12位、100ksps的8通道ADC，帶PGA和模擬多路開關； l 8位、500ksps的ADC，帶PGA和8通道模擬多路開關； l 兩個12位DAC，具有可編程數據更新方式； l 64KB可在系統(tǒng)編程的Flash存儲器； l 4352（4096+256）B的片內RAM； l 可尋址64KB地址空間的外部數據存儲器接口；

30、 l 硬件實現的SPI、SMBus/IIC和兩個UART串行接口； l 5個通用的16位定時器； l 具有5個捕捉/比較模塊的可編程計數器/定時器陣列； l 片內看門狗定時器、VDD監(jiān)視器和溫度傳感器； l 兩種可軟件編程的電源管理方式------空閑方式（等待方式）和停機方式（掉電方式）； l C8051F020工作電壓2.7V-3.6V，端口I/O、/RST和JTAG引腳都容許5V的輸入信號電壓； l 64個IO口， TQFP100封裝； l 與其它8位單片機相比，有更高的程序安全性； 3.5電機轉速控制 3.5.1電機轉速控制原理 根據直流電機轉速方程

31、 （3-1） 式中 U— 電樞電壓（V）； I — 電樞電流（A）； R — 電樞回路總電阻（ W ）； — 勵磁磁通（Wb）； — 由電機結構決定的電動勢常數。 可推出有三種方法調節(jié)電動機的轉速： （1）調節(jié)電樞供電電壓 U； （2）減弱勵磁磁通 F； （3）改變電樞回路電阻 R。 對于要求在一定范圍內無級平滑調速的系

32、統(tǒng)來說，以調節(jié)電樞供電電壓的方式為最好。改變電阻只能有級調速；減弱磁通雖然能夠平滑調速，但調速范圍不大，往往只是配合調壓方案，在基速（即電機額定轉速）以上作小范圍的弱磁升速。 因此，自動控制的直流調速系統(tǒng)往往以調壓調速為主。 3.5.2電機轉速控制方案 由上可得電機直流調速系統(tǒng)往往以調壓調速為主,電壓可采用模擬電路實現.即通過改變電路中的電阻可得到可連續(xù)變化的可調電壓;也可通過數字電路實現,即通過PWM波來實現。模擬電路法功耗大，且對于精確控制來說非常困難。固一般均采用PWM驅動法。 PWM驅動原理是就是直流斬波原理，利用大功率晶體管的開關特性來調制固定電壓的直

33、流電源。按一個固定的頻率來接通和關斷，并根據需要改變一個周期內“接通”和“斷開”時間的長短，通過改變直流電動機電樞上的占空比來改變平均電壓的大小，從而控制電機的轉速。因此，這種裝置又稱為“開關驅動裝置”。 PWM輸出波形如圖1.3所示，周期為T，一個周期內的導通時間為t，則加在電機兩端的平均電壓為： (3-2) 其中，α= t /T稱為占空比，為電源電壓。 圖3.7 PWM原理圖 直流電機的轉速與

34、電機兩端電壓成正比，而電機兩端的平均電壓與控制波形的占空比成正比，占空比越大，電機轉得越快，當占空比為1時，加在電機兩端的平均電壓最大，電機轉速也就最大。 3.6 電機驅動電路 單片機雖然可以輸出PWM波，但其輸出功率太小，無法滿足電機工作的需求，固要有功率放大器，一般功率放大器都是有MOS管或IGBT來放大，而這些分立元件組合起來就是一個完整的功率放大器。現代電子技術是朝著高度集成化方向發(fā)展的，由于這些功率放大器在生產生活中引用廣泛，尤其是電機的普遍應用，所以市場上有專門的針對電機的功率放大芯片。本文選擇的是智能功率芯片BTS7960。其資料如下： BTS7960是Novalit

35、hIC家族三個獨立的芯片的一部分:一是p型通道的高電位場效應晶體管，二是一個n型通道的低電位場效應晶體管，結合一個驅動晶片,形成一個完全整合的高電流半橋。所有三個芯片是安裝在一個共同的引線框,利用芯片對芯片和芯片芯片技術。電源開關應用垂直場效應管技術來確保最佳的阻態(tài)。由于p型通道的高電位開關，需要一個電荷泵消除電磁干擾。通過驅動集成技術，邏輯電平輸入、電流取樣診斷、轉換速率調整器，失效發(fā)生時間、防止欠電壓、過電流、短路結構輕易地連接到一個微處理器上。BTS7960可結合其他的BTS7960形成全橋和三相驅動結構。 圖框如下： 圖3.8 B

36、TS7960圖框 引腳的定義和功能 表3.3 BTS7960引腳的定義和功能 以下是其驅動電機的應用實例： 圖3.9 BTS7960驅動電機電路 綜上所述，我們可得出系統(tǒng)硬件的系統(tǒng)框圖為 圖3.10 系統(tǒng)硬件框圖 4 系統(tǒng)控制方案設計 4. 1操縱桿設計 方案一：速度的給定由用戶通過操縱桿來實現。操縱桿輸出兩路相互垂直的模擬信號，來

37、實現控制輪椅運動的方向和速度，如圖所示： 圖4.1 操縱桿輸出信號分解 在上圖（a）中，操縱桿搬動的方向和傾斜的程度分解為和兩路互相垂直的信號輸出；在圖（b）中，輪椅運動的方向V由X方向的速度分量和Y方向的速度分量適量合成。設左，右輪的轉速分別為，，則易知為兩輪的差模分量，為兩輪轉速的共模分量。，，，按照下面的算法建立聯(lián)系： 式中,為X和Y方向的控制靈敏系數，,值越大，對相應通道的操縱桿輸出信號的檢測就越靈敏。通過適當配置,就能獲得滿意的操縱性能。是由速度擋設定的系數，速度擋越高，越大轉速給定也就越大。依據上兩式即可將用戶給定的控制信

38、號分別轉化為左右兩輪的給定速度。 方案二：我們直接對電機進行控制，翻轉電機只需一個開關，即可實現翻轉電機的爬樓動作；行使電機則需要兩個開關，一個控制左行使電機，一個控制右行使電機，當兩個開關同時按下則實現直線行走，只開一個時實現轉向，轉速則通過單片機調節(jié)PWM波的占空比來實現無極調速。 方案一是目前市場上專用控制手柄采用的方案，其操縱簡單，但成本相當高昂，且對硬件電路要求也非常高，需要提供相應的硬件接口與信號處理電路。實物圖如下： 圖4.2專用控制手柄實物圖 而方案二雖然操縱復雜點，但其成本較低廉，硬件易于實現，控制

39、可靠，操作人員經過短時間的訓練即可適應。固采用方案二，下圖為控制開關分布圖： 圖4.3 控制開關分布圖 方案二要解決的一個突出問題即為雙電機的同步實現，因為行使是要實現直線行使的，不能跑偏，更為重要的是爬樓梯時，必須兩個電機轉速相同，否則會產生危險，使安全性大大降低。下面將講述雙電機的同步控制方案。 4. 2雙電機同步控制方案 目前存在的同步控制技術包括并行控制、主從控制、交叉耦合控制、虛擬總軸控制、偏差耦合控制。這里對并行控制和主從控制這兩種基本的控制方式作一下簡單的介紹和比較。 4.2.1 并行控制 并行控制是一種基于同一定值控制的并聯(lián)運行方式，這是一

40、種最簡單的同步控制方法。并行式適用于每個單獨系統(tǒng)的控制目標基本一致的情況，要求伺服系統(tǒng)具有良好的速度穩(wěn)定性。調速系統(tǒng)采用同一給定電壓，其控制結構圖如圖4.4所示。采用并行運行方式的同步控制系統(tǒng)其優(yōu)點在于啟動和停止階段系統(tǒng)的同步性能很好，但是由于整個系統(tǒng)相當于開環(huán)控制，當運行過程中某一臺電機受到擾動時，電機之間將會產生同步偏差，同步性能較差。 控制器 電機1 控制器 電機2 圖4.4 并行控制結構圖 4.2.2 主從控制 主從控制是一種基于跟蹤隨動原理的串聯(lián)運行方式。以雙電機為例，主從同步控制系統(tǒng)的結構圖如圖1.2所示。

41、在這種控制方式中，主電機的輸出轉速作為從電機的轉速參考值。由此可推斷，任何加在主電機上的速度命令或是負載擾動都會被從電機反映并且跟隨，但是任何從電機上受到的擾動卻不會反饋回給主電機，也不會影響到其他的從電機。 主從式特點是從系統(tǒng)跟蹤主系統(tǒng)的輸出，大大增加了其控制策略的穩(wěn)定性，但存在跟蹤滯后。這種控制方式要求伺服系統(tǒng)具有良好的跟蹤性能，主要應用在對速度或者位置的同步精度不是很高的工業(yè)生產中。 控制器 控制器 電機1 電機2 圖4.5 主從控制結構圖 本系統(tǒng)設計的電機同步控制為了提高抗干擾能力，在一臺電機速度受到外部擾動或人為干擾時兩臺

42、電機仍能保持速度的同步，采用了帶速度負反饋的主從式控制結構，因為其穩(wěn)定性很好，這對爬樓輪椅是相當有利的，速度負反饋可以確保相應的控制精度。跟蹤滯后問題可以通過pid算法和構建控制電路校正網絡電路進行改進。 5 輪椅車控制算法設計 5.1 速度檢測電路 測速元件是閉環(huán)調速系統(tǒng)中的關鍵元件，為了擴大調速范圍，改善電動機的低速平穩(wěn)性，要求測速元件低速輸出穩(wěn)定，波紋小，線性度好。常用的測速元件有模擬式測速元件和數字式測速元件。模擬式測速元件通常采用測速發(fā)電機；數字式測速元件采用光電式脈沖發(fā)生器。數字測速元件

43、具有低慣量低噪聲高分辨率和高精度的特點，有利于控制直流電機。在現代驅動控制系統(tǒng)中，為了提高速度反饋檢測精度，正在摒棄直流測速發(fā)電機加A/D轉換器的方案，而采用光電碼盤直接數字測速的方案。 本系統(tǒng)采用增量式光電旋轉編碼器測量電機的速度。將光電編碼器與電動機相連，當電動機轉動時，帶動碼盤旋轉，便發(fā)出相應的信號。光電編碼器由光源，光電轉盤，光敏元件和光電整形放大電路組成。光電轉盤與被測軸連接，光源通過光電轉盤的透光孔射到光敏元件上，當轉盤轉動時，光敏元件便發(fā)出與轉速成正比的脈沖信號，為了判別電機的轉向，光電編碼器輸出兩路相隔90度電脈沖角度的正交脈沖。 利用光電編碼器進行數字測速的常用方法有兩種

44、：M法和T法。 （1）M法測速：M法又叫定時計數法，是用計數器記取規(guī)定時間內光電編碼器輸出的脈沖個數來反映轉速值，即在規(guī)定的時間間隔T內，測量編碼器光柵所產生的脈沖數來獲得被測的速度值。設編碼器光柵每轉一圈發(fā)出的脈沖數為Z，且在規(guī)定的時間T內，測得的脈沖數為M，則電機每分鐘轉數為： n=60M/ZT （5-1） 將轉速實際值和測量值之差與實際值之比定義為測量誤差率δ，δ反映了測速方法的準確性，δ越小，準確度越高。M法測速誤差率取決于編碼器的制造精度，以及編碼器輸出脈沖前沿和測速時間采樣脈沖前沿不齊所造成的誤差等，最多可以產生一個脈沖的誤

45、差。因此，M法測速誤差率的最大值為： （5-2） 由上式可知，誤差率δ與M成反比，即脈沖數越大，誤差越小，故M法測速適用于高速段。 （2）T法測速：T法又叫定數計時法，是用定時器記取光電編碼器輸出脈沖一個周期內的高頻時基個數，然后取其倒數來反應速度值，即測量相鄰兩個脈沖的時間間隔來確定被測速度。設編碼器光柵每轉一圈發(fā)出的脈沖數為Z，定時器的時基是一已知頻率為F的高頻脈沖，定時器的起始和終止由編碼器光柵脈沖的兩個相鄰脈沖的起始沿控制。若定時器的讀數為M，則電機每分鐘的轉速為：

46、 （5-3） T法測速的誤差產生原因與M法相仿，定時器的計數M最多存在一個脈沖的誤差，因此，T法測速誤差率的最大值為： （5-4） 低速時，編碼器相鄰脈沖間隔時間長，測得的高頻脈沖個數多，誤差小，故T法適用于低速段。 我們采用M法測速。所采用的光電編碼器光柵每轉一圈發(fā)出1000個脈沖。設電機工作在額定轉速下，即n=500轉/分，則在0.1秒的采樣間隔內，計數器所應接受到的標準脈沖個數為M=500/60*0.1*1000=833個，可以看出，精度還是較高的。 本設計中速度反饋回路的原理圖

47、下圖所示。 圖5.1 速度反饋原理圖 5.2 PID控制方法 5.2.1 PID控制方法介紹 PID控制是迄今為止最通用的控制策略，有許多不同的方法以確定合適的控制器參數，根據現代理論的觀點，PID調節(jié)器具有本質的魯棒性、符合二次型最優(yōu)控制選型原則、且具有智能化的專家特色。PID調節(jié)器及其改進型是在工業(yè)過程控制中最常見的控制器。 PID控制是比例積分微分控制的簡稱，本身是一種基于對“過去”、“現在”和“未來”信息估計的控制算法，最早出現在模擬控制系統(tǒng)中，通過硬件（電子元件，氣動和液壓元件）來實現。 控制器系統(tǒng)原理圖如圖5.2所示。 現 在 過 去 未 來 對

48、 象 圖5.2 模擬PID控制系統(tǒng)原理圖 PID的三種控制規(guī)律可以組成不同的線性控制器。在電力傳動控制系統(tǒng)中，常采用的串聯(lián)校正控制裝置有比例微分（PD）控制器、比例積分（PI）控制器及比例積分微分（PID）控制器。由PD控制器構成的超前校正可以提高穩(wěn)定裕度并獲得足夠的快速性，但穩(wěn)態(tài)精度可能受到影響；由PI控制器構成的滯后校正，可以保證穩(wěn)態(tài)精度，但快速性不佳；用PID控制器實現的滯后-超前校正兼有二者的優(yōu)點，可以全面提高系統(tǒng)的控制性能。 連續(xù)控制系統(tǒng)中的模擬PID控制規(guī)律為:

49、 （5-5） 式中, u ( t ) 控制器的輸出 e ( t ) 控制量的偏差 Kp 比例系數 Ti 積分時間常數 Td 微分時間常數 (1) 比例環(huán)節(jié) 比例環(huán)節(jié)對偏差是即時反應的，偏差一旦出現，調節(jié)器立即產生控制作用，使輸出量朝減小偏差的方向變化，控制作用的強弱取決于比例系數Kp。比例調節(jié)器雖然簡單快速，但對于系統(tǒng)響應為有限值的控制對象存在靜差。加大比例系數Kp可以減小靜差，但過大會使系統(tǒng)的動態(tài)質量變壞，引起輸出量震蕩,甚至導致系統(tǒng)不穩(wěn)定。 (2) 積分環(huán)節(jié) 為了消除在比例調節(jié)中

50、的殘余靜差，可在比例調節(jié)的基礎上加入積分調節(jié)。積分調節(jié)具有累積成分，只要偏差e不為零，它將通過累積作用影響控制量u，從而減小偏差，直到偏差為零。如果積分時間常數Ti大，則積分作用弱，反之為強。增大Ti將減慢消除靜差的過程，但可減小超調，提高穩(wěn)定性。引入積分環(huán)節(jié)的代價是降低系統(tǒng)的快速性。 (3) 微分環(huán)節(jié) 為了加快控制過程，有必要在偏差出現或變化的瞬間，按偏差變化的趨勢進行控制，使偏差消滅在萌芽狀態(tài)，這就是微分調節(jié)的原理。微分作用的加入將有助于減小超調，克服震蕩，使系統(tǒng)趨于穩(wěn)定，特別對高階系統(tǒng)非常有利，它加快了系統(tǒng)的跟蹤速度，但對噪聲非常敏感，使用前需要對輸入信號進行濾波。 5.2

51、.2 數字式增量PID控制算法 計算機控制是一種采樣控制，它只能根據采樣時刻的偏差值計算控制量。因此，連續(xù)PID控制算法不能直接使用，需要采用離散化方法，根據采樣時刻的偏差值計算控制量，離散化得： （5-6） 式中 k為采樣序號，k=0,1,2,3… 如果采樣周期足夠小，這種離散逼近相當精確。式中u（k）為全量輸出，它對應于被控對象的執(zhí)行機構第k次采樣時刻應達到的位置。因此，上式稱為PID位置型控制算式。 可以看出，按PID位置

52、型控制算式計算u(k)時，輸出值與過去所有狀態(tài)有關。當執(zhí)行機構需要的不是控制量的絕對數值，而是其增量時(如步進電機的驅動)，可導出下式： （5-7） 其中， 此式稱為增量型PID控制算式，增量型PID控制算式具有以下優(yōu)點： 1. 計算機只輸出控制增量，即執(zhí)行機構位置的變化部分，

53、因而誤動作影響小。 2. 在k時刻的輸出u(k)，只需要用到此時刻的偏差，及前兩次的偏差和前一次的輸出值，這大大節(jié)約了內存的計算時間。 3. 在手動-自動切換時，控制量沖擊小，能夠較平滑地過渡。 位置式控制算法可通過增量式控制算法推出遞推計算公式： （5-8） 這就是目前在計算機控制中廣泛應用的數字遞推PID控制算式。 5.2.3 標準PID算法的改進 在實際過程中，控制變量因受到執(zhí)行元件機械和物理性能的約束而限制在有限范圍內，即Umin

54、出上述范圍，例如超出最大閥門開度或進入執(zhí)行元件的飽和區(qū)，那么實際執(zhí)行的控制量就不再是計算值，由此將引起不希望的效應，這類效應通常稱為飽和效應。這類現象在給定值發(fā)生突變時特別容易發(fā)生，所以有時也稱為啟動效應。下面,我們分析這類效應在PID算法中帶來的影響及克服的辦法： 若給定值w從0突變到w0，且根據PID位置算法算出的控制量超出限制范圍，那么實際上控制量只能取上界值Umax，而不是計算值。此時系統(tǒng)輸出y雖不斷上升，但由于控制量受到限制,其增長要比沒有限制時慢。偏差e將比正常情況下持續(xù)更長的時間保持在正值，而使PID位置算式中的積分項有較大的累積值。當輸出超過給定值w0后，開始出現負偏差，但由

55、于積分項的累積值很大，還要經過相當一段時間后控制變量u才能脫離飽和區(qū)，這樣，就使系統(tǒng)出現了明顯的超調。 顯然，在PID位置算法中“飽和作用”主要是由積分項引起的，故稱為”積分飽和”?？朔e分飽和的方法有： 1．遇限削弱積分法。這一修正算法的基本思想是，一旦控制變量進入飽和區(qū)，將只執(zhí)行削弱積分項的運算而停止進行增大積分項的運算。具體說，在計算ui時，將判斷上一時刻的控制量ui-1是否已超出限制范圍，如果已超出，那么將根據偏差的符號，判斷系統(tǒng)輸出是否在超調區(qū)域，由此決定是否將相應偏差計入積分項。 2．積分分離法。減小積分飽和的關鍵在于不能使積分項累積過大。上面的方法是一開始就積分，但進入限制

56、范圍后即停止累積。積分分離法與其相反，它在開始時不積分，直到偏差達到一定閥值后才進行積分累積。這樣，一方面防止一開始有過大的控制量，另一方面即使進入飽和后，因積分累積小，也能較快退出，減少了超調。 5.2.4 干擾的抑制 PID控制算法的輸入量是偏差e，也就是給定值與系統(tǒng)輸出的差。在進入正常調節(jié)后，由于輸出已接近給定，e的值不會太大。所以相對而言，干擾對調節(jié)有較大的影響，除了從系統(tǒng)硬件及環(huán)境方面采取措施外，在控制算法上也可采取一定的措施，以抑制干擾的影響。 對于作用時間較為短暫的快速干擾，例如采樣器，A/D轉換器的偶然出錯等，我們可以簡單地采用連續(xù)多次采樣求平均值的辦法予以濾除。例如圍

57、繞著采樣時刻ti連續(xù)采樣N次，可得到ei1、ei2、… 、eiN。由于快速干擾往往比較強烈，只要有一個采樣數據受到快速隨機干擾，即使對它們求平均值，干擾的影響也會反映出來。因此，應剔除其中的最大最小值，對其余的N-2次采樣求平均值。由于在N次中連續(xù)偶然出錯的可能很小，故這樣做已足以消除這類快速隨機干擾的影響。 5.2.5 PID調節(jié)器的參數整定 PID調節(jié)器的設計一般來說可分為兩個部分，首先是選擇調節(jié)器的結構，以保證閉環(huán)系統(tǒng)的穩(wěn)定，并盡可能消除穩(wěn)態(tài)誤差。如要求系統(tǒng)穩(wěn)態(tài)誤差為零，則應選擇包含積分環(huán)節(jié)的調節(jié)器如PI，PID等。對于有滯后性質的對象，往往引入微分環(huán)節(jié)等。另外，根據對象和對控制性

58、能的要求，還可采用一些改進的PID算法。一旦調節(jié)器的結構確定下來，下一步的任務就是調節(jié)器參數的整定。 采樣周期的選定 進行數字PID控制器參數整定時，首先應該解決的一個問題是確定合理的采樣周期T。采樣周期T必須足夠短，才能保證有足夠的精度。但采樣周期短則會加重計算機的任務，影響工作效率，因此應合理選擇采樣周期。 采樣周期T應遠遠小于系統(tǒng)中其它的時間常數，否則可能會由于采樣的頻帶寬度不夠而無法反映系統(tǒng)的動態(tài)過程。一般來說，采樣周期T的最大值受系統(tǒng)穩(wěn)定性條件和香農采樣定理的限制而不能太大。T的最小值則受到計算機在一個采樣周期內能完成的計算工作量的限制，實際中常選2PAI/T為系統(tǒng)有用

59、信號最高頻率的4~10倍。系統(tǒng)的給定頻率較高時，采樣周期T相應減少，以使給定的變化得到反映。采樣周期還與所采用的控制算法和執(zhí)行機構的類型有關。當采用數字PID控制算法時，積分作用和微分作用都與采樣周期有關。選擇T太小時，e（k）變化就很小，積分和微分作用將都不明顯。此外，通常執(zhí)行機構慣性較大，采樣周期T應能與之相適應。如果系統(tǒng)的干擾是高頻的，則要適當的選擇采樣周期，使得干擾信號的頻率處入采樣器頻帶之外，從而使系統(tǒng)具有足夠的抗干擾能力。如果干擾是頻率已知低頻干擾，為了能夠采用濾波的方法排除干擾信號，采樣頻率應該與干擾信號的頻率成整數倍的關系。 PID參數的整定 采樣周期T通常遠遠小于

60、系統(tǒng)的時間常數，因此，PID參數的整定可以按模擬調節(jié)器的方法來進行。參數整定通常有兩種：理論設計法和實驗確定法。前者需要有被控對象的精確模型，然后采用最優(yōu)化的方法確定PID的各參數。被控對象的模型可通過物理建?；蛳到y(tǒng)辨識方法得到，但這樣通常只能得到近似的模型。因此，通過實驗確定法（如試湊法，工程整定法）來選擇PID參數是經常采用又行之有效的方法。本方案采用了試湊法。試湊前先要知道PID各調節(jié)參數對系統(tǒng)響應的影響。 試湊法是通過計算機仿真或實際運行，觀察系統(tǒng)對典型輸入作用的

61、響應曲線，根據各調節(jié)參數（Kp，Ti，Td）對系統(tǒng)的影響，反復調節(jié)試湊，直到滿意為止，從而確定PID參數。 增大比例系數Kp將加快系統(tǒng)響應并減小系統(tǒng)穩(wěn)態(tài)誤差，但過大會產生較大的超調量，產生震蕩，破壞系統(tǒng)的穩(wěn)定性。 增大積分時間常數Ti可使減小超調，提高系統(tǒng)穩(wěn)定性，但系統(tǒng)誤差的消除將隨之變慢。 增大微分時間常數Td可加速系統(tǒng)的響應，使超調量減小，增加系統(tǒng)的穩(wěn)定性，但系統(tǒng)抗干擾能力下降。 試湊時，可參考以上參數對控制系統(tǒng)性能的影響趨勢，實行先比例，后積分，再微分的反復調整。 （1）首先只調比例系數，將Kp由小到大，使響應曲線略有超調。此時系統(tǒng)若無穩(wěn)態(tài)誤差或穩(wěn)態(tài)誤差已小到允許范圍內，并且認

62、為響應曲線已屬滿意，那么，只須用比例調節(jié)器即可。 （2）若在比例調節(jié)的基礎上，系統(tǒng)穩(wěn)態(tài)誤差太大，則必須加入積分環(huán)節(jié)。整定時先將第一步所整定的比例系數略為縮?。ㄈ?.8倍），再將積分時間常數Ti置為一較大值并連續(xù)減小，使得在保持良好動態(tài)性能的前提下消除穩(wěn)態(tài)誤差。這一步可反復進行。 （3）若使用PI調節(jié)器消除了穩(wěn)態(tài)誤差，但系統(tǒng)動態(tài)響應經反復調整后仍不能令人滿意，則加入微分環(huán)節(jié)，構成PID控制器。在整定時先將微分時間常數Td設定為零，再逐步增加Td并同時進行前面兩步的調整，以獲得滿意的調節(jié)效果和控制參數。 需要指出，PID調節(jié)器的參數對控制系統(tǒng)性能的影響通常并不十分敏感，參數整定結果可以不唯一

63、。 70 6 輪椅車控制模塊的數學模型 針對雙電機同步驅動控制在負載發(fā)生擾動時同步控制性能較差的問題，建立了兩臺直流電動機同步控制系統(tǒng)（速度控制）的數學模型。主要解決的問題是對兩臺直流電動機同步控制系統(tǒng)結構圖進行分析，畫出結構框圖，算出傳遞函數， 對于國家標準有著嚴格要求的控制器標準，由此可以對其進行校正，構建校正網絡電路，從而使得系統(tǒng)能夠得到較好的性能指標?？捎行Ы鉀Q控制系統(tǒng)快速性和平穩(wěn)性的矛盾，使系統(tǒng)具有更高的同步控制精度。本文僅建立輪椅車控制模塊的數學模型，對于控制器的優(yōu)化問題已是現實的生產實際問題不在本文研究范圍內，故沒有進行論述。 本方案是

64、一個雙直流電機同步驅動控制系統(tǒng)。主電機轉速由操作者通過加減速開關直接給定，而從電機對其進行跟隨同步轉動，我們只需通過控制器調整加于從電機上的pwm波來控制從電機。在該系統(tǒng)中，直流電機的轉速由測速傳感器進行轉換，由電源直接為系統(tǒng)提供輸入量，并經過控制器和驅動電路之后，作為電機的驅動信號以驅動電機工作，再通過兩個測速傳感器的差值對系統(tǒng)進行反饋，當測速傳感器的差值不等于零時，通過反饋進行調節(jié)。若差值為零，保持電機運轉。 6.1 系統(tǒng)運行方框圖 圖6.1系統(tǒng)運行方框圖 6.2系統(tǒng)運行原理 在給定電壓 輸入下，電機1在控制器1及驅動電路1的作用下

65、開始運行，控制器1將預定轉速轉化為信號使驅動電路作用直流電機，使之達到預定轉速。同理，直流電機2在控制器2及驅動電路2的作用下運行，測速傳感器2將電機1的速度數據與電機1測速傳感器測得的速度數據進行比較，將電機1和電機2的速度差值作為反饋系統(tǒng)的輸入量，通過調節(jié)，使電機1和電機2實現同步控制的目的。 6.3建立數學模型 （1）控制器 圖6.2 控制器電路圖 可得 式中 本方案的控制器，承擔著對輸入信號進行控制的任務，除了對干擾信號的清除作用之外，還兼具有整流作用。在整個控制過程當中

66、，也會對輸入信號的其他一些因素起到一定的影響。放大功能就是其中之一，由于在控制器之后會再直接接上驅動電路，起到真正的放大信號作用，最終實現對電機的驅動。所以控制器還是以實現控制作用為主。所以在考慮參數的選擇的時候，應該盡量考慮到對輸入信號的控制和整流等，而不是使信號放大。所以應注意適當選取比例，微分，積分參數（通過實驗可獲得較好的效果）。 由此可得控制器框圖： 圖6.3 控制器框圖 （2）驅動器 圖6.4 驅動器電路圖 我們選取驅動電路的目的，是為了對輸入信號進行放大，輸入一個較小的信號，經過驅動電路放大之后，使之能夠達到對電機驅動的目的。結合相應的實際情況，可以選取驅動器當中的兩個放大器件， 串聯(lián)。 由此可得驅動器框圖： 圖6.5 驅動器框圖 （3）直流電機 圖6.6 直流電機的等效電路圖 由直流電機的等效電路圖可得： 為電樞反電動勢，方向與電樞電壓相反 為反電樞系數，電磁矩方程 為電機轉矩系數，為