基于A(yíng)RM的自主式移動(dòng)機器人電路設計
自主式移動(dòng)機器人系統是指根據指令任務(wù)及環(huán)境信息進(jìn)行自主路徑規劃,并且在任務(wù)執行過(guò)程中不斷采集局部環(huán)境信息,做出決策,從而實(shí)現安全行駛并準確到達目標地點(diǎn)的智能系統。本文以L(fǎng)PC2119為控制核心,介紹了一種輪式移動(dòng)機器人的設計方案。該機器人系統應用超聲傳感器、光敏傳感器、碰撞傳感器采集外部環(huán)境信息,采用PTR2000實(shí)現移動(dòng)機器人與計算機通信,從而實(shí)現現場(chǎng)信息的反饋和計算機控制命令的發(fā)送。
本文引用地址:http://dyxdggzs.com/article/201710/369450.htmLPC2119是Philips公司推出的支持實(shí)時(shí)仿真和跟蹤的arm7TDMI-S微處理器,嵌入128KB高速Flash存儲器。它采用3級流水線(xiàn)技術(shù),取指、譯碼和執行同時(shí)進(jìn)行,能夠并行處理指令,提高CPU運行速度。由于其具有非常小的尺寸和極低的功耗,非常適合小型化應用。片內多達64KB的SRAM,具有較大的緩沖區規模和強大的處理能力。LPC2119內部集成2個(gè)CAN控制器、2個(gè)32位定時(shí)計數器和4個(gè)ADC單元電路。
電機的PWM控制電路設計
IR2110是美國IR公司推出的一種雙通道、高壓、高速的功率器件柵極驅動(dòng)的單片式集成驅動(dòng)器。它把驅動(dòng)高壓側和低壓側MOSFET或IGBT所需的絕大部分功能集成在一個(gè)高性能的封裝內,外接很少的分立元件即能提供極快的開(kāi)關(guān)速度和極低的功耗。其特點(diǎn)在于:將輸入邏輯信號轉換成同相位低阻抗輸出驅動(dòng)信號,可驅動(dòng)同一橋臂上的2路輸出,驅動(dòng)能力強,響應速度快;工作電壓較高,可達600V;內設欠壓封鎖;成本低、易于調試;電路芯片體積小,為DIP14 封裝。高壓側驅動(dòng)采用外部自舉電容上電,與其他IC驅動(dòng)電路相比,在設計上大大減少了驅動(dòng)變壓器和電容的數目,降低了產(chǎn)品成本,減小了體積,提高了系統的可靠性。這種適用于驅動(dòng)功率MOSFET和IGBT的自舉式集成電路,在電源變換、電機調速等功率驅動(dòng)領(lǐng)域中獲得了廣泛的應用。
LPC2119單片機的PWM功能建立在標準定時(shí)器上,它具有32位的定時(shí)控制器及預分頻控制器、7個(gè)匹配控制器,可實(shí)現6個(gè)單邊PWM或3個(gè)雙邊PWM輸出,也可以使用這兩種類(lèi)型的混合輸出。此系統使用端口PWM0和PWM1輸出兩路PWM信號,分別控制移動(dòng)機器人的2個(gè)驅動(dòng)電機。PWM信號經(jīng)過(guò)光電耦合器形成兩路相位相差180°的信號加到IR2110的HIN和LIN引腳上,實(shí)現對同一橋臂上的兩個(gè)MOSFET開(kāi)關(guān)的控制,原理如圖1所示。
HIN為高電平期間,Q1、Q4導通,在直流電機上加正向工作電壓;HIN為低電平期間,LIN端輸入高電平,Q2、Q3導通,在直流電機上加反向工作電壓。因此電樞上的工作電壓是雙極性矩形脈沖波形。由于機械慣性的作用,矩形脈沖電壓的平均值決定電動(dòng)機的轉向和轉速。
超聲傳感器系統
為減輕控制器LPC2119的負擔,超聲傳感器系統由Atmel公司的AT89C1051單片機控制。1051單片機是含有一個(gè)1KB可編程E2PROM的高性能微控制器,它與工業(yè)標準MCS-51的指令和引腳兼容。它為很多嵌入式控制應用提供了一個(gè)高度靈活、有效的解決方案。AT89C1051有以下特點(diǎn):1KB的E2PROM、128B的RAM、15根I/O線(xiàn)、2個(gè)16位定時(shí) /計數器、5個(gè)二級向量中斷結構、1個(gè)全雙向的串行口且內含精密模擬比較器和片內振蕩器,具有4.25~5.5V的電壓工作范圍及24MHz工作頻率,同時(shí)還具有加密陣列的二級程序存儲器加鎖、掉電和時(shí)鐘電路等。此外,AT89C1051還支持兩種軟件設置的電源節電方式??臻e時(shí),CPU停止,而RAM、定時(shí)/計數器、串行口和中斷系統繼續工作。掉電時(shí),保存RAM的內容,但振蕩器停振以禁止芯片其他功能,直到下一次硬件復位。
1051控制每60ms發(fā)送一路超聲波,檢測回波時(shí)間,并完成距離的計算。這樣16路超聲波循環(huán)檢測一次約為1s,在常溫時(shí)超聲波的速度約為344m/s,可以計算出障礙物的距離,最后將超聲波傳感器編號及距離信息傳送給LPC2119。超聲波發(fā)射及接收子系統如圖2所示。1051利用P1.0引腳向外發(fā)送40kHz的脈沖信號,此信號作為4-16譯碼器74HC154的使能信號,引腳P1.1~P1.4作為譯碼信號,分別對應編號0~15的超聲波傳感器。此信號經(jīng)過(guò)9013放大后推動(dòng)換能器產(chǎn)生40kHz的超聲波信號。
LM567是一片鎖相環(huán)電路,其5、6腳外接的電阻和電容決定了內部壓控振蕩器的中心頻率f2,f2≈1/1.1RC。其1、2腳分別通過(guò)電容器接地,形成輸出濾波網(wǎng)絡(luò )和環(huán)路單級低通濾波網(wǎng)絡(luò )。2腳所接電容決定鎖相環(huán)路的捕捉帶寬:電容值越大,環(huán)路帶寬越窄。LM567的工作電壓為 4.75~9V,工作頻率從直流到500kHz,靜態(tài)工作電流約8mA。
本設計是一個(gè)基于arm7微處理器的車(chē)載嵌入式系統,不僅滿(mǎn)足了移動(dòng)機器人控制系統的要求而且為機器人的轉型應用提供了良好的技術(shù)支持。在此基礎上可以加入各種先進(jìn)的控制算法,實(shí)現移動(dòng)機器人的智能化。
評論