利用電磁導(dǎo)航的AGV設(shè)計
摘要:隨著物流系統(tǒng)的迅速發(fā)展,AGV的應(yīng)用范圍也在不斷擴(kuò)展,為了滿足用戶功能、價格、質(zhì)量方面需求的AGV系統(tǒng),研究設(shè)計了一種基于電磁導(dǎo)航的無人駕駛小車系統(tǒng)方案。通過實(shí)際硬件實(shí)驗(yàn),系統(tǒng)能夠達(dá)到預(yù)期設(shè)計要求,能夠廣泛運(yùn)用于工業(yè)、軍事、交通運(yùn)輸、電子等領(lǐng)域,具有良好的環(huán)境適應(yīng)能力,很強(qiáng)的抗干擾能力和目標(biāo)識別能力。
關(guān)鍵詞:電磁導(dǎo)航;AGV;無線傳輸;控制算法
0 引言
AGV(Automated Guided Vehicle)是指裝備有電磁或光學(xué)等自動導(dǎo)引裝置,能夠沿規(guī)定的導(dǎo)引路徑行駛,具有各種移載功能的運(yùn)輸車。無人AGV廣泛地應(yīng)用于現(xiàn)代工業(yè)控制系統(tǒng)中,能完成人工條件下不能完成的任務(wù),可以保障系統(tǒng)在不需要人工導(dǎo)航的情況下自動行駛。
AGV包含了自動控制系統(tǒng)、引導(dǎo)方式的系統(tǒng)和信息無線傳輸?shù)炔糠帧Mㄟ^各種算法研究,該設(shè)計有效地確定了小車的位置且能很好控制小車運(yùn)行狀態(tài)。小車運(yùn)行時,可以實(shí)時采集數(shù)據(jù)并傳回電腦,從而很好地對周圍環(huán)境進(jìn)行監(jiān)控。系統(tǒng)利用電磁軌道(Electromagnetic path-following System)設(shè)立其行進(jìn)路線,電磁軌道黏貼於地板上,無人搬運(yùn)車則依循電磁軌道所帶來的信息進(jìn)行移動與動作,并自動采集相關(guān)信息。根據(jù)小車采集的信息,上位機(jī)給小車發(fā)送指令,控制攝像頭轉(zhuǎn)動,以便獲取不同區(qū)域的視頻信息。
1 系統(tǒng)硬件設(shè)計
AGV系統(tǒng)結(jié)構(gòu)框如圖1所示,上位機(jī)首先通過遙控的方式給小車指定運(yùn)行路徑;小車上的電磁傳感器將采集到的電磁信號經(jīng)過放大檢波變成直流電壓信號,單片機(jī)再對該信號進(jìn)行模/數(shù)轉(zhuǎn)換,利用PID算法,獲取小車距離中心位置的偏差,再把差值賦給舵機(jī),從而實(shí)現(xiàn)小車沿著導(dǎo)線的中心自動運(yùn)行;最后,小車采集的數(shù)據(jù)實(shí)時傳回電腦顯示,與此同時,上位機(jī)可給小車發(fā)出指令,讓小車執(zhí)行相關(guān)任務(wù)。
1.1 中央控制器
中央處理器采用Freescale公司推出的S12系列單片機(jī)中的一款增強(qiáng)型16位單片機(jī)MC9S12DG128(以下簡稱DG128),片內(nèi)資源及I/O接口豐富,接口模塊包括SPI,SCI,IIC,A/D,PWM等,在汽車電子應(yīng)用領(lǐng)域具有廣泛的用途。
MC9S12G128的單片運(yùn)行方式是最常用的應(yīng)用方式。因片內(nèi)已經(jīng)有較大的RAM,F(xiàn)LASH空間,一般無需擴(kuò)展外部RAM或外部FLASH。本設(shè)計應(yīng)用DG128來實(shí)現(xiàn)對系統(tǒng)的總體控制。
1.2 速度采集模塊
速度檢測利用霍爾效應(yīng)來實(shí)現(xiàn)。當(dāng)一塊通有電流的金屬或半導(dǎo)體薄片垂直地放在磁場中時,薄片的兩端就會產(chǎn)生電位差,兩端具有的電位差值稱為霍爾電勢U,其表達(dá)式為:
U=K·I·B/d (1)
式中:K為霍爾系數(shù);I為薄片中通過的電流;B為外加磁場(洛倫茲力Lorrentz)的磁感應(yīng)強(qiáng)度;d是薄片的厚度。
霍爾片的輸入端是以磁感應(yīng)強(qiáng)度B來表征的,當(dāng)B值達(dá)到一定的程度時,霍爾開關(guān)內(nèi)部的觸發(fā)器翻轉(zhuǎn),霍爾開關(guān)的輸出電平狀態(tài)也隨之翻轉(zhuǎn)。輸出端一般采用晶體管輸出,和接近開關(guān)類似。當(dāng)有磁鋼接近霍爾片的時候時(在一定的距離范圍內(nèi)才有反應(yīng)),設(shè)置單片機(jī)定時器的時間為t,計數(shù)器計數(shù)為n,一個轉(zhuǎn)盤上的磁鋼數(shù)量為s,則轉(zhuǎn)速(單位:r/s)的計數(shù)公式為:
speed=(n/s)/t (2)
評論