輪式機器人電機驅(qū)動系統(tǒng)設(shè)計
《輪式機器人電機驅(qū)動系統(tǒng)設(shè)計》由會員分享,可在線閱讀,更多相關(guān)《輪式機器人電機驅(qū)動系統(tǒng)設(shè)計(19頁珍藏版)》請在裝配圖網(wǎng)上搜索。
1、 本科畢業(yè)論文(設(shè)計、創(chuàng)作) 題目: 輪式機器人電機驅(qū)動系統(tǒng)設(shè)計 學(xué)生姓名:學(xué)號:081002100 所在院系:專業(yè): 電氣工程及其自動化 入學(xué)時間: 2010 年 9 導(dǎo)師姓名:職稱/學(xué)位: 副教授/碩士 導(dǎo)師所在單位: 完成時間: 2014 年 5 月 安徽三聯(lián)學(xué)院教務(wù)處 制 輪式機器人驅(qū)動系統(tǒng)設(shè)計 摘 要:隨著社會的發(fā)展,機器人逐漸受到了人們的重視,可移動輪式機器人的研
2、究具有極其重要的意義。其關(guān)鍵的問題就是要解決機器人在復(fù)雜環(huán)境下系統(tǒng)的正常運行和控制,因此輪式機器人的驅(qū)動系統(tǒng)顯得尤為重要。本文設(shè)計了一款智能輪式機器人的驅(qū)動系統(tǒng),此系統(tǒng)的核心是STC89C52單片機,通過系統(tǒng)產(chǎn)生的寬帶調(diào)制信號,加上L298N驅(qū)動芯片控制直流電機的運行參數(shù),可實現(xiàn)機器人的基本動作:前進、后退、左右轉(zhuǎn)向、速度控制以及避障循跡功能。此次系統(tǒng)研究為機器人驅(qū)動系統(tǒng)的發(fā)展與創(chuàng)新積累了經(jīng)驗,對機器人控制系統(tǒng)的研究發(fā)展具有理論與實踐價值。 關(guān)鍵詞:驅(qū)動; PMW; 單片機; 速度控制; 方向控制 Wheeled Robot Drive System Design Abstrac
3、t: With the development of the society,robot has gradually become more popular. It is more important to research the removable wheeled robot .The key problem is that how to operate and control the robot in complicated situation, so the drive system of it plays an important role. This dissertation is
4、 dedicated to showing a new design of intelligent removable wheeled robot whose kernel lies at the STC89C52 Single Chip Micyoco.The signal of PMW produced by that system and also the operating parameter of direct-current machine controlled by L298N drive chip could realize the basic movement of the
5、robot ,such as advance, back ,turn, speed control,and the function of avoiding obstacles and following previous track. This research gathers experience for the development and creation of robot drive system ,and it also has a high theoretical and practical value of the development of the robot contr
6、ol system. Key words:drive; PMW; Single Chip Micyoco; speed control; direction control 目錄 1 緒論1 1.1引言1 1.2研究背景和意義1 1.3研究內(nèi)容2 2 驅(qū)動系統(tǒng)方案設(shè)計3 2.1主控系統(tǒng)3 2.2電機驅(qū)動模塊3 2.3機械系統(tǒng)4 2.4電源模塊4 3主要零部件及技術(shù)分析5 3.1單片機的介紹5 3.1.1 時鐘電路6 復(fù)位6 3.1.3 STC89C52主要功能6 3.2驅(qū)動模塊方案的分析7 3.2.1 H型橋式驅(qū)動電路7 3.2.2 L298N驅(qū)動模
7、塊組成及各部分功能9 3.3PWM控制12 PWM調(diào)速簡介12 3.3.2 PWM控制電機的特點12 PWM輸出波形和計算13 3.4直流電動機特性簡介13 4機器人運動控制介紹16 4.1總體設(shè)計概括16 4.2外圍電路拓展16 避障模塊16 4.3控制流程圖錯誤!未定義書簽。 5 總結(jié)20 致謝21 參考文獻22 1 緒論 1.1 引言 當(dāng)今社會發(fā)展迅速,人民生活水平提高,自動化設(shè)備充實了我們的生活,方便了我們的生活,提高了人們的生活和工作質(zhì)量。機器人的發(fā)展也及其迅速,從以前的國家高端軍事航空領(lǐng)域滲透到我們生活中的每個角落。小至樓宇辦公、餐醫(yī)療,大到航
8、空航天、軍事武器、重工業(yè)生產(chǎn),大量的各種各樣的機器人充實著我們的生活,其環(huán)境適應(yīng)能力強,能夠完成人類不能完成的任務(wù)。隨著現(xiàn)代化的逼近,人們都機器人的需求越來越高,機器人的種類需求越來越大,機器人所肩負(fù)的使命越來越重要,使機器人的控制變得越來越復(fù)雜。現(xiàn)在整體機器人研究方向朝三個目標(biāo)發(fā)展:一是機器人的高智能化。二是讓機器人更像人。三是讓機器人更小,能夠勝任更精細的工作。因此需要在機器人的驅(qū)動控制系統(tǒng)以及算法上深入研究。 1.2研究背景和意義 進入21世紀(jì),經(jīng)濟全球化及多元化快速發(fā)展,人類進入智能化信息化時代。人們對信息的獲取量、信息的傳遞周期、人們的生活水平、工作質(zhì)量提出了更高的要求。更多信息
9、,更舒適的生活環(huán)境,更方便快捷的工作方式是現(xiàn)代每個人所共同期望的。機器人在各個領(lǐng)域發(fā)展極為迅速,在各個技術(shù)難題上都有了很大的突破。生活類的機器人走進了普通家庭,如安保、教育、清潔、服務(wù)、娛樂、康復(fù)、治療等智能機器人獲得了極高的評價和社會實用價值,為廣大人們所歡迎。 機器人技術(shù)是眾多學(xué)科知識交叉融匯的結(jié)晶,對人工智能、模式識別、自動控制、電子電氣、機械設(shè)計電子電路等多個學(xué)科提出了很高的要求,復(fù)雜條件下運動控制系統(tǒng)是機器人完成智能化多功能化中最基礎(chǔ)的研究內(nèi)容,它涉及自動控制,電子電氣,電子電路等多個領(lǐng)域;機器人運動控制系統(tǒng)的研究是機器人智能化進程中的關(guān)鍵所在,對自動控制、電子電氣相關(guān)領(lǐng)域的發(fā)展意
10、義重大。 現(xiàn)代工業(yè)、軍事裝備、航空航天以及民用領(lǐng)域無處不依賴機器人,其對我國現(xiàn)代化建設(shè)提高人民工作生活質(zhì)量意義重大。機器人可歸結(jié)為三個大類,第一種是一代機器人,亦可稱作示教再現(xiàn)型機器人,是通過一臺計算機來控制一個可自由調(diào)整工作角度的機械,將程序和信息存儲進入示教,機器運行時隨時調(diào)取數(shù)據(jù)信息發(fā)出指令。如此便可重復(fù)的根據(jù)實時示教結(jié)果,再現(xiàn)出種動作,例如點焊機器人,它只要首次完成點焊示教,以后便重復(fù)這種工作,但是其不能感知外界環(huán)境,所以此種機器人不能獨自判斷用力大小工件是否存在以及焊點的好壞,因此第一代機器人存在很多缺陷。自20世紀(jì)70年代末期,第二代機器人的研究相繼開始,稱作帶感覺的機器人,這種
11、帶感覺的機器人能模仿人類的某些感覺,如力度的大小、觸碰、滑落、視覺成像、聽力和人進行相類比,有了這些基礎(chǔ)感知能力,當(dāng)機器人抓一個物體的時候,它實時用力大小就能感覺出來,亦能夠通過視覺成像,去感受和識別它的形狀、大小、顏色。拿一只雞蛋,其能通過特種觸覺實時測算力矩和滑動的情況。 第三代機器人,是現(xiàn)代對機器人研究中所要攀登的最高階段,稱為智能機器人,此種機器人可人工聲控,只需下達命令機器人就能以特種方式完成任務(wù),也就是其能自主思考將要如何完成任務(wù)。能像人一樣去思考一件事情該怎么去做,該不該做,此種概念型機器人還局限在某些領(lǐng)域內(nèi)能夠達到這種智能水平,完全具備像人腦這樣的思維境界的機器人還不存在,但
12、是我們相信科技的發(fā)展進步,更多智能概念的豐富,將會向著這種概念型機器人無限趨近。。 1.3研究內(nèi)容 對于工業(yè)機器人的設(shè)計可分為三部分:執(zhí)行部件、驅(qū)動系統(tǒng)和控制系統(tǒng)??刂葡到y(tǒng)包括決策、策略構(gòu)思和執(zhí)行機構(gòu)。決策層可實時識別環(huán)境,構(gòu)建模型概念,將將要執(zhí)行的任務(wù)分割成最基礎(chǔ)動作序列;策略層將基本動作轉(zhuǎn)變?yōu)殛P(guān)節(jié)坐標(biāo)協(xié)調(diào)變化的規(guī)律,分配給各關(guān)節(jié)的伺服系統(tǒng);執(zhí)行機構(gòu)將某種特定序列及坐標(biāo)變化規(guī)律分配給不同的關(guān)節(jié)伺服系統(tǒng)。一般對機器人的研究有對機器人在運動中平穩(wěn)性的研究;有在復(fù)雜環(huán)境下自主運行及自我診斷的研究;有對機器人在不同環(huán)境下的通訊能力的研究;還有對機器人小型化甚至微型化的研究。 本設(shè)計的是一種基于
13、單片機最小系統(tǒng)的輪式移動機器人的驅(qū)動系統(tǒng)。此系統(tǒng)選用STC89C52單片機為核心,通過其產(chǎn)生的PWM信號控制驅(qū)動芯片;系統(tǒng)連接完成,實現(xiàn)對電機的起停調(diào)速控制。因此我們需要研究驅(qū)動電路的控制原理以及實現(xiàn)方法,了解何為PWM及其產(chǎn)生方法、工作原理,單片機對機器人的控制原理,控制算法,討論使用何種電源。了解機器人的電源分配、穩(wěn)壓、電路保護方法,選擇合適的電機種類為其動力裝置,保障機器人的靈活性。 2 驅(qū)動系統(tǒng)方案設(shè)計及論證 2.1主控系統(tǒng) 依據(jù)設(shè)計內(nèi)容的要求可知此系統(tǒng)輸入變量多,系統(tǒng)控制復(fù)雜,因此可草擬兩種設(shè)計構(gòu)思進行整體比較論證,論點如下: 方案一: 選用一片CPLD(如EPM7128L
14、C84-15)作為系統(tǒng)的核心部件,實現(xiàn)控制與處理的功能。CPLD運算速度快、編程較為簡單、可用資源頗為豐富、開發(fā)實現(xiàn)周期短等優(yōu)點,編程可用VHDL語言。但CPLD在控制上不如單片機,其運算速度極快,機器人的運轉(zhuǎn)速度不需要很高,所以其整個系統(tǒng)不需要過高的信息處理能力,按照此種要求,MCU就足能完成處理任務(wù)。所以此種方案會給控制問題帶來很多不必要的麻煩,不優(yōu)先考慮此種構(gòu)思。 方案二: 以單片機為系統(tǒng)核心,實現(xiàn)對運行中的機器人實時數(shù)據(jù)采集處理,達到需要的性能指標(biāo)。實際上此系統(tǒng)關(guān)鍵是要對機器人運動控制實現(xiàn),重點放在這上面的話,不難發(fā)現(xiàn)單片機具有很大的優(yōu)勢,控制簡單快捷,這樣一來,資源極其豐富、控制
15、能力極強以及可位尋址的優(yōu)點顯露無疑。因此此種構(gòu)思較為理想 此設(shè)計內(nèi)容具有如下特點:開關(guān)量輸入量多,系統(tǒng)控制較為復(fù)雜,因此不宜使用精簡版的點數(shù)極少的單片機。為此可選用STC89C52單片機作為系統(tǒng)的核心,因為其具有很強的位操作功能,輸入輸出口也可四線位尋址,此系列單片機擁有8K可用資源,足以滿足系統(tǒng)要求,其次51單片機低廉的價格也是其不可掩埋的優(yōu)勢。 兩種方案對比中選擇51系列單片機更適合此系統(tǒng),故決定采用STC89C52為此設(shè)計的核心處理器。 2.2電機驅(qū)動模塊 方案一: 用繼電器控制電機的運行和停止,利用開關(guān)檔的切換控制小車的速度,這樣設(shè)計出來的電路極為簡單易懂容易實現(xiàn),但是長時間
16、的高頻率的開關(guān)降低了繼電器的使用壽命,而且繼電器響應(yīng)時間慢可靠性不高。 方案二: 電機速度和運行狀態(tài)的調(diào)節(jié)可使用電阻網(wǎng)絡(luò)或者數(shù)字電位器。關(guān)鍵在于電阻網(wǎng)絡(luò)不能實現(xiàn)連續(xù)調(diào)速,可靠性不高,性能指標(biāo)不易實現(xiàn)。數(shù)字電位器價格代價過高,在此系統(tǒng)使用不夠理想。電機阻值較小且電流又比較大,效率很低難以實現(xiàn)分壓。 方案三: 直流電動機的控制可用功率三極管。由達林管可組成H型橋式電路,線性驅(qū)動電路不僅電路和原理簡單而且其具有較強的加速能力,采用此種H橋電路只要工作在占空比可調(diào)的狀態(tài)便可實時精確調(diào)節(jié)電機運行狀態(tài),而且此電路運行效率可觀,調(diào)節(jié)精度高,控制簡單穩(wěn)定性好,是很常用的PWM調(diào)速技術(shù)。根據(jù)以上分析,此
17、系統(tǒng)可選用L298N電機驅(qū)動芯片。 2.3機械系統(tǒng) 此種機器人要求機械系統(tǒng)穩(wěn)定,運動靈活簡單,可采用兩輪式前驅(qū)方式,兩輪各由一部直流電機帶動,利用前兩輪差速控制其轉(zhuǎn)向,后輪可采用雙輪亦可采用萬向輪從動,亦起到支撐作用使整個硬件系統(tǒng)穩(wěn)定平衡。 由于機器人裝有兩個電機、電池包、電路板等電子器件,使整個機械系統(tǒng)較重,為了能輕松完成機器人的啟動,平穩(wěn)運行,可在電機和輪軸之間裝上三級調(diào)速齒輪。 可將電池包安裝在整個機械系統(tǒng)的前方,保證整體重心較低,提高系統(tǒng)穩(wěn)定性,也增加了前輪的抓地能力,不會因為打滑而使系統(tǒng)失控。 2.4電源模塊 用兩塊分別為6V和12V的電池包分別為電動機和驅(qū)動芯片供電,既
18、保證了的可持續(xù)性,又可保證芯片的不受電機波動對電流的影響。 3主要零部件及技術(shù)分析 3.1單片機的介紹 STC89C52具有一個8K的只讀存儲器,且可編程可擦除,性能很高,通常簡稱為單片機。此種單片機制造技術(shù)先進,價格低廉,并且兼容于MCS-51指令集和輸出管腳。 圖1 STC89C52實物圖 圖2 STC89C52引腳圖 3.1.1 時鐘電路 STC89C52單片機有兩種時鐘產(chǎn)生方式,其內(nèi)部振蕩器是有兩只反向放大器構(gòu)成。采用內(nèi)部方式產(chǎn)生震蕩時只需外界定時原件便可在內(nèi)部產(chǎn)生自激震蕩。采用外部時鐘電路時只需保證脈沖寬度即可,正常采用12MHz一下方波信號。 3.1.2復(fù)位
19、復(fù)位是單片機的初始化操作。執(zhí)行此復(fù)位操作可將PC值置0。當(dāng)進入系統(tǒng)時將進行正常情況下的初始化,如果出現(xiàn)系統(tǒng)鎖死時也可手動按鍵復(fù)位重啟。復(fù)位操作也會對其他寄存器產(chǎn)生影響,其復(fù)位值如下表所示。 表1 寄存器 復(fù)位狀態(tài) 寄存器 復(fù)位狀態(tài) PC 0000H TCON 00H ACC 00H TL0 00H PSW 00H TH0 00H SP 07H TL1 00H DPTR 0000H TH1 00H P0-P3 FFH SCON 00H IP XX000000B SBUF 不確定 IE 0X000000B PCON 0XXX
20、0000B TMOD 00H RST引腳是復(fù)位信號的輸入端。復(fù)位信號是高電平有效,其有效時間應(yīng)持續(xù)24個振蕩周期(即二個機器周期)以上。 3.1.3 STC89C52主要功能如下表: 表2 STC89C52主要功能 兼容MCS51指令系統(tǒng) 8K可反復(fù)擦寫Flash ROM 32個雙向I/O口 256x8bit內(nèi)部RAM 3個16位可編程定時/計數(shù)器中斷 時鐘頻率0-24MHZ 2個串行中斷 可編程UART串行通道 2個外部中斷源 共6個中斷源 2個讀寫中斷口線 3級加密位 低功耗/掉電模式 睡眠/喚醒 3.2驅(qū)動模塊方案的分析 機器人的工作可持
21、續(xù)性以及穩(wěn)定性的指標(biāo),電池包的性能起到?jīng)Q定性作用,其次取決于電機驅(qū)動系統(tǒng)的效率。電動機器人驅(qū)動系統(tǒng)可細分為控制器、功率變換器及電機。高轉(zhuǎn)矩、較大的寬帶調(diào)速范圍、較高的可靠性是電動輪式機器人驅(qū)動系統(tǒng)的基本要求。本系統(tǒng)采用的是直流電動機,此電機控制簡單,性能好,而且直流電源在移動物體上容易實現(xiàn)。 3.2.1 H型橋式驅(qū)動電路 因為此驅(qū)動電路的形狀很像字母H,所以簡單稱其為H橋驅(qū)動電路,現(xiàn)在直流電機的驅(qū)動電路多采用此種H型全橋,此種電路可很容易的實現(xiàn)電機基本運行方式,如正反轉(zhuǎn)和正反制動。它的基本原理如圖3所示: 圖3 H橋驅(qū)動電路 當(dāng)Q1、Q4工作在導(dǎo)通狀態(tài)時,電流就從正極經(jīng)過Q1三極管流
22、經(jīng)電機到達Q4,直到流回負(fù)極形成回路電流,如下圖4所示,粗的黑色箭頭標(biāo)明的是電流流動軌跡,細的環(huán)形箭頭標(biāo)明的是電機轉(zhuǎn)轉(zhuǎn)方向。 圖4 H橋電路驅(qū)動電機順時針轉(zhuǎn)動 同理,圖5標(biāo)明了另外兩只三極管導(dǎo)通時的電機及電流運行軌跡。 圖5 H橋驅(qū)動電機逆時針轉(zhuǎn)動 圖6 具有使能控制和方向邏輯的H橋電路 值得注意是必須要保證電機正常運行,就要控制同側(cè)的兩個管子不能同時工作在導(dǎo)通狀態(tài)。如果三極管Q1和Q2同時導(dǎo)通,那么電流就會從正極穿過兩個三極管直接回到負(fù)極。因為此電路中用電器比較少,電流很大從而燒壞三極管,所以在實際應(yīng)用時要通過電路來控制三極管開關(guān)。 如上圖6所示,通過電路的進一步改
23、進,在此電路上加了四個與門兩個非門,便可保證H橋的同側(cè)最多只有一個三極管可以導(dǎo)通。 綜上所述,控制兩個方向信號及一個始能信號便可控制電動機的運行,DIR-L=0則DIR-R=1,始能信號=1,電機正傳;反之電機反轉(zhuǎn),如圖7所示。 圖7 使能信號與方向信號的使用 3.2.2 L298N驅(qū)動模塊組成及各部分功能 此種驅(qū)動芯片是SGS公司旗下的產(chǎn)品,內(nèi)含兩個H橋的高電壓大電流全橋式驅(qū)動器,可以用來驅(qū)動直流電動機和步進電動機、繼電器線圈等感性負(fù)載;標(biāo)準(zhǔn)邏輯電平信號控制;有兩個使能控制端,在不受輸入信號影響的情況下允許或禁止器件工作有一個邏輯電源輸入端,使內(nèi)部邏輯電路部分在低電壓下工作;可以外接
24、檢測電阻,將變化量反饋給控制電路。使用L298N芯片可以驅(qū)動一臺兩相步進電機或四相步進電機,也可以驅(qū)動兩臺直流電機。二相及四相電機專用其作為驅(qū)動器,可驅(qū)動46V、2A以下電機,其實物及引腳圖如下圖8和圖9所示: 圖8 L298N芯片實物圖 圖9 管腳圖 表3 L298N參數(shù) 尺寸 80mmX45mm 工作電壓 控制信號直流5V,電機電壓直流3V-46V 最大工作電流 2.5A 額定功率 25W 特點 具有信號指示,轉(zhuǎn)速可調(diào),抗干擾能力強,具有電壓和電流保護,可獨控制兩臺直流電機,PWM脈寬平滑調(diào)速,可實現(xiàn)正反轉(zhuǎn)。 圖10 管腳連接示意圖 接口連接說明: +5
25、V:芯片電壓5V。 VCC:電機電壓12V。 GND:共地接法。 IN1-IN4接單片機。 ENA\ENB接單片機高電平有效。 L298N邏輯功能如下表: 表4 L298N邏輯功能表 IN1 IN2 ENA 電機 X X 0 停止 1 0 1 順時針 0 1 1 逆時針 0 0 0 停止 1 1 0 停止 3.3PWM控制 3.3.1PWM調(diào)速簡介 PWM控制技術(shù)是一種脈沖寬度調(diào)制技術(shù),采用該技術(shù)可等效獲得想要的波形。通過控制電路通斷來獲得所需脈沖。用此方式輸出的波形平滑諧波少,再按特定規(guī)則進行脈寬調(diào)制
26、,獲得所需電壓大小和輸出頻率。 要控制電機轉(zhuǎn)速,通常采用脈寬調(diào)制(PWM),基本方法是在特定頻率下向電機提供脈沖方波,利用不同占空比的方波信號對電機進行調(diào)速。其原因是電機線圈會產(chǎn)生很大的感抗,阻礙了輸入電流和電壓的突變能力,這樣的話脈沖輸入信號就被分配到作用時間上,通過改變始能端輸入方波的占空比來改變電機兩端的電壓大小,從而達到精調(diào)電機轉(zhuǎn)速的目的。以下介紹兩種方法實現(xiàn)脈寬調(diào)制: (1)用軟件方式來實現(xiàn):編寫延時程序,當(dāng)執(zhí)行程序時交替改變端口輸出狀態(tài),即可獲得脈寬調(diào)制信號。要獲得不同的占空比只要改變延時時間。 (2)采用硬件獲得調(diào)制信號,無需CPU參與,減小CPU處理周期。 3.3.2
27、PWM控制電機的特點 電機在靜止?fàn)顟B(tài)下突然啟動時會有一個很大的靜態(tài)摩擦力,電機轉(zhuǎn)子與負(fù)載質(zhì)量會產(chǎn)生摩擦力,電動機本身也會產(chǎn)生很大的摩擦力,可簡單概括為電機啟動時的阻力力矩,當(dāng)電機的轉(zhuǎn)矩小于阻力力矩時電機無法啟動,且會因此系統(tǒng)會產(chǎn)生大量的熱量,但是這種方法也有其優(yōu)點,就是控制原理簡單輸出波動小,線性好,對其他電路干擾小。 只要半導(dǎo)體功率器件工作在開關(guān)狀態(tài)便可通過寬帶調(diào)制控制電機出入電壓,進一步控制電機運行速度。開關(guān)驅(qū)動方式可調(diào)節(jié)功率半導(dǎo)體工作在此狀態(tài),當(dāng)開關(guān)管的驅(qū)動信號為高電平時,開關(guān)管導(dǎo)通,直流電動機電樞繞組兩端有電壓U。在連續(xù)的兩個時間區(qū)間內(nèi)驅(qū)動信號高低電平切換,以此重復(fù)即可。 3.3
28、.3 PWM輸出波形和計算 圖11電壓波形圖 電樞繞組兩端電壓平均值U為: U =(t1×U)/(t1+t2) =( t1×U)/T=D*U 式中D為占空比,D=t/T,D為一個周期T內(nèi)的開關(guān)管導(dǎo)通時間t與T的比值。D在0 ≤D≤1區(qū)間內(nèi)變化,占空比D的大小決定著電壓平均值U,通過改變D的值改變輸出電壓的值,實現(xiàn)PWM調(diào)速??捎脤掝l調(diào)速、調(diào)款調(diào)頻、定頻調(diào)寬法調(diào)整占空比,通常采用的是定頻調(diào)寬。占空比越大則輸出平均電壓越大,電機轉(zhuǎn)動的也就越快,反之越慢。 3.4直流電動機特性簡介 直流電動機的機械特性方程式為: 式中 UN 、ΦN ——額定電樞電壓、額定磁通量; Ke 、Kt
29、—— 與電機有關(guān)的常數(shù); Rad、Ra——電樞外加電阻、電樞內(nèi)電阻; n0、△n——理想空載轉(zhuǎn)速、轉(zhuǎn)速降; n---電動機轉(zhuǎn)速。 分析上式可得,當(dāng)分別改變 UN和 Rad時,可以得到不同的轉(zhuǎn)速 n,從而實現(xiàn)對速度的調(diào)節(jié)。由于Φ =F(If),當(dāng)改變勵磁電流If時,可以改變磁通量ΦN的大小,從而達到變磁通調(diào)速的目的。但由于勵磁線圈發(fā)熱和電動機磁飽和的限制,電動機的勵磁電流 If和磁通量 ΦN只能在低于其額定值的范圍內(nèi)調(diào)節(jié),故只能弱磁調(diào)速。而對于調(diào)節(jié)電樞外加電阻 Rad 時,會使機械特性變軟,導(dǎo)致電機帶負(fù)載能力減弱。于他勵直流電機來說,當(dāng)改變電樞電壓 UN時,分析人為機械特性方程式
30、,得到人為特性曲線如圖16所示: 圖12 直流電機機械特性曲線 如圖15所示,理想空載轉(zhuǎn)速n0隨電樞電壓升降而發(fā)生相應(yīng)的升降變化。不同電樞電壓的機械特性曲線相互平行,說明硬度不隨電樞電壓的變化而改變,電機帶負(fù)載能力恒定。當(dāng)我們平滑調(diào)節(jié)他勵直流電機電樞兩端電壓時,可實現(xiàn)電機的無級調(diào)速?;谝陨咸匦裕淖冸姌须妷?,實現(xiàn)對直流電機速度調(diào)節(jié)的方法被廣泛采用。 4 機器人運動控制介紹 4.1總體設(shè)計概括 根據(jù)以上技術(shù)及專業(yè)知識分析,此系統(tǒng)以STC89C52單片機為核心,采用兩塊L298N驅(qū)動芯片分別驅(qū)動兩個直流電機,通過PWM脈寬調(diào)速控制直流電機轉(zhuǎn)速。整體采用三輪機械設(shè)計,前面設(shè)計兩輪差速控
31、制方向,后輪可采用兩輪從動,也可采用萬向輪做支撐。電源采用分開供電方式,用兩塊電池包分別為電機和單片機供電。 4.2 外圍電路拓展 要實現(xiàn)機器人的運動控制,就要求其要具備基本的前進后退,左轉(zhuǎn)右轉(zhuǎn)以及避開障礙物的能力,這些功能要求其自主完成。下面介紹機器人避障功能的實現(xiàn)。 4.2.1避障模塊 機器人避障有一下三種基本情況。第一種正前方障礙避障;第二種左側(cè)障礙避障;第三種右側(cè)障礙避障。所以要實現(xiàn)以上三種避障功能,需要在小車上至少安裝三組紅外對管,一個安裝在正前方,另外兩個安裝在小車前方,方向向外偏30度到45度角,具體角度需要實物調(diào)試。 1.機器人啟動后正常運行軌跡應(yīng)該是直線運行,當(dāng)前方
32、暈倒障礙物時,可設(shè)定其規(guī)律性左轉(zhuǎn)避障,左轉(zhuǎn)一定的角度,前進一定的距離,如此重復(fù)運動,當(dāng)前方不在有障礙物時,再按照之前轉(zhuǎn)動的角度和次數(shù)右轉(zhuǎn),成功避開障礙物時再按照原始方向前進。 2.正常運行時,前方左側(cè)紅外探頭檢測到障礙物時,可設(shè)定其規(guī)律定右轉(zhuǎn)一定角度,再前進一定距離,若不再檢測到障礙物時,再讓機器人按照原來轉(zhuǎn)動的角度和次數(shù)左轉(zhuǎn),以便回到以前的方向運行。 3.當(dāng)右側(cè)紅外探頭檢測到障礙物時,設(shè)定其一律左轉(zhuǎn)。左轉(zhuǎn)前進交替進行,直到不再檢測到障礙信號為止,再按照左轉(zhuǎn)的角度和次數(shù)右轉(zhuǎn),回到原來的方向上運動。 實際上除了以上三種情況,還有可能兩個或者三個紅外對管都檢測到障礙信號。若左側(cè)和前方
33、對光管同時檢測到信號,則規(guī)定其按照第2中情況作出相應(yīng)動作。若右側(cè)和前方同時檢測到信號,則按照第三種情況處理。若三個管子同時檢測到信號,則程序控制機器人停止前進,并后退一一段距離至信號消失,再按照情況3處理。 如下圖13所示為紅外對管發(fā)射和接收管實物圖。紅外發(fā)射管發(fā)射紅外光信號,當(dāng)遇到障礙物時,其發(fā)射的紅外光會反射給接收管,此時電力路接收到障礙物信號,信號轉(zhuǎn)變?yōu)殡娦盘査徒o單片機處理,做出相應(yīng)動作。 圖13 紅外發(fā)光和接收對管 4.3控制流程圖 Stc89c52 時鐘電路 復(fù)位電路 電機驅(qū)動電路路diandianlu 避障紅外對管 圖14 主板設(shè)計框圖 啟動
34、 前進 障礙? 停止 壁障? 停止? Y N N Y 圖15 機器人運動控制流程圖 表5元器件清單 原件 數(shù)量 原件 數(shù)量 原件 數(shù)量 直流電機 2只 電阻 若干 L298N 2只 單片機 一塊 二極管 若干 電容 若干 紅外對管 3只 電位器 若干 12MHz晶振 1只 玩具車框架 一個 排針 若干 固定綁線 若干 圖16 電機驅(qū)動電路圖 5 總結(jié) 此系統(tǒng)是以STC89C52單片機為核心的輪式機器人驅(qū)動系統(tǒng)。采用L298N電機驅(qū)動芯片及PWM技術(shù)基本實現(xiàn)機器人啟停轉(zhuǎn)向速度控制,另外通過對外圍電路的拓展
35、增加了系統(tǒng)的循跡和避障功能,使整個系統(tǒng)功能更加完善。通過此次設(shè)計我掌握了以前不熟悉的知識,認(rèn)識了很多新的東西。使我認(rèn)識了自己在很多方面的欠缺不足。 致謝 經(jīng)過查閱眾多專家老師的文獻資料,整理編寫了這樣一篇輪式機器人驅(qū)動系統(tǒng)的設(shè)計論文。在構(gòu)思過程中,指導(dǎo)老師和同學(xué)給予了很多寶貴的意見和建議,在設(shè)計過程中,陳老師教會了我思考問題解決問題的方法,在設(shè)計所需資料及環(huán)境上給與了大力支持和幫助。在此我對陳老師表示真摯的感謝!同時感謝所有幫助過我的同學(xué)!感謝老師抽出寶貴的時間對本文評閱! 參考文獻 [1]郭惠.吳迅. 單片機C語言程序設(shè)計完全自學(xué)手冊[M]
36、. 電子工業(yè)出版社,2008.10:1-200. [2]王東鋒.王會良.董冠強. 單片機C語言應(yīng)用100例[M]. 電子工業(yè)出版社。2009.3:145-300. [3]趙巍.馮娜. 單片機基礎(chǔ)及應(yīng)用[M]. 北京:清華大學(xué)出版社,2009:94-103. [4] 高慧芳.單片機原理及系統(tǒng)設(shè)計[M]. 杭州:杭州電子科技大學(xué).2008:124-174. [5] 聶詩良.李磊民. 采用單片機發(fā)送并接收紅外遙控信號的方法[J]. 信息技術(shù).2004,28(2):21-96. [6] 施新華, 利用單片機實現(xiàn)的紅外遙控技術(shù).[J]. 上海電機學(xué)院學(xué)報.2006,9(3):69-71. [
37、7]韓毅.楊天. 基于HCS12單片機的智能尋跡模型車的設(shè)計與實現(xiàn)[J].學(xué)術(shù)期刊.2008,29(18):1535-1955. [8]王曉明. 電動機的單片機控制[J]. 學(xué)術(shù)期刊.2002,13(15):1322-1755. [9]何立民,單片機應(yīng)用系統(tǒng)設(shè)計[M]. 北京:航天航空大學(xué)出版社,2002:46~50. [10]李廣弟, 單片機基礎(chǔ)[M], 北京:北京航空航天大學(xué)出版社,2001:56~64. [11]Yamato I , et al 1 New conversion system for UPS using high fre2 quency link[J ]1 IEEE PESC ,1988 :210-320. [12]Yamato I , et al 1 High frequency link DC/ AC converter for UPS with a new voltage clamper[J ]1IEEE PESC ,1990 :52-105. [13]LM79XXseries-terminal Negative Regulators National Semiconductor 2001.9
- 溫馨提示:
1: 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請下載最新的WinRAR軟件解壓。
2: 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
3.本站RAR壓縮包中若帶圖紙,網(wǎng)頁內(nèi)容里面會有圖紙預(yù)覽,若沒有圖紙預(yù)覽就沒有圖紙。
4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
5. 裝配圖網(wǎng)僅提供信息存儲空間,僅對用戶上傳內(nèi)容的表現(xiàn)方式做保護處理,對用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對任何下載內(nèi)容負(fù)責(zé)。
6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請與我們聯(lián)系,我們立即糾正。
7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時也不承擔(dān)用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。