謝 檬, 郭 霞
(西安交通大學(xué) 城市學(xué)院,陜西 西安 710018)
?
智能小車控制系統(tǒng)設(shè)計(jì)
謝 檬, 郭 霞
(西安交通大學(xué) 城市學(xué)院,陜西 西安 710018)
以16位低功耗單片機(jī)MSP430F5438為控制核心,以直流電機(jī)作為驅(qū)動的動力,設(shè)計(jì)了智能小車并采用脈寬調(diào)制(PWM)方式實(shí)現(xiàn)對車速的準(zhǔn)確控制;使用灰度傳感器來檢測起點(diǎn)/終點(diǎn)標(biāo)志線及轉(zhuǎn)彎/超車標(biāo)志線;在超車區(qū)使用超聲波傳感器來測量兩輛小車之間的距離,并在軌道的超車區(qū)內(nèi)進(jìn)行超車;使用無線通信模塊來進(jìn)行兩車之間的超車通信,有效避免兩車相撞并順利實(shí)現(xiàn)超車;用電子指南針模塊來對兩小車進(jìn)行精確定位及轉(zhuǎn)彎控制和在行車道上方向的校正。通過對樣機(jī)進(jìn)行了測試,結(jié)果表明:智能小車可以實(shí)現(xiàn)單車?yán)@圈行駛、兩車防撞前后行駛、兩車在規(guī)定的區(qū)域完成超車等功能,且其性能穩(wěn)定、抗干擾性強(qiáng),在無人駕駛系統(tǒng)方面得到廣泛應(yīng)用。
光電傳感器; 超聲波傳感器; 電子指南針; 無線通信
智能小車作為機(jī)器人的典型代表,相對于傳統(tǒng)的汽車有著更好的安全性、機(jī)動性和廣泛的適用性[1~3],是一個集合環(huán)境感知、規(guī)劃決策,自動行駛等功能于一體的綜合系統(tǒng)。智能小車主要應(yīng)用領(lǐng)域?yàn)椋很娛聜刹炫c環(huán)境探測;探測危險與排除險情;安全檢測受損評估;智能家居等[4~6]。生活小區(qū)內(nèi)路面情況簡單,行人多、機(jī)動車少,采用無人駕駛的電力通勤車最為合適。
1.1 智能小車的結(jié)構(gòu)框圖
智能小車的硬件結(jié)構(gòu)采用MSP430F5438為微控制器,控制整個無人駕駛小車系統(tǒng),對內(nèi)部AD采集的數(shù)據(jù)進(jìn)行處理,發(fā)出小車直走、轉(zhuǎn)彎、超車等控制指令,從而完成特定的功能。智能小車的硬件結(jié)構(gòu)框圖如圖1所示,采用RPR220光電傳感器來檢測拐彎超車標(biāo)志線;采用超聲波傳感器來控制兩車間距;采用GY—26電子指南針對小車進(jìn)行定位和導(dǎo)航;采用SRWF—1021無線通信模塊實(shí)現(xiàn)甲乙兩輛小車車間的通信。
圖1 智能小車的硬件結(jié)構(gòu)框圖Fig 1 Hardware structure of smart car
1.2 電機(jī)驅(qū)動模塊
采用專用芯片L298N作為電機(jī)驅(qū)動芯片。L298N是一個具有高電壓大電流的全橋驅(qū)動芯片,一片L298N可以分別控制兩個直流電機(jī),且有控制使能端。用該芯片作為電機(jī)驅(qū)動,操作方便,穩(wěn)定性好,性能優(yōu)良,且由L298N結(jié)合單片機(jī)可實(shí)現(xiàn)對小車速度的精確控制。這種調(diào)速方式有調(diào)速特性優(yōu)良、調(diào)整平滑、調(diào)速范圍廣、過載能力大,能承受頻繁的負(fù)載沖擊,還可以實(shí)現(xiàn)頻繁的無級快速啟動、制動和反轉(zhuǎn)等優(yōu)點(diǎn)。通過接口發(fā)送PWM波,控制電機(jī)轉(zhuǎn)速,實(shí)現(xiàn)速度可調(diào),通過控制PWM波的相位控制電機(jī)的轉(zhuǎn)向。
1.3 光電傳感器模塊
五通道灰度值檢測傳感器模組以RPR220光電傳感器為探測傳感器,共分為5路,分為2行5列。通過對每個傳感器數(shù)據(jù)的檢測,可以實(shí)現(xiàn)對直線、丁字路線、十字路線進(jìn)行跟蹤和檢測。
1.4 超聲波模塊電路
超聲波的發(fā)射與接收是獨(dú)立式的,采用超聲波發(fā)射換能器TCT40—16BT和超聲波接收換能器TCT40—16BR。可以向外界發(fā)出40 kHz左右的方波脈沖信號,輸出端上拉電阻既可以提高反向器MC14069UB輸出高電平的驅(qū)動能力,也可以增加超聲換能器的阻尼效果,縮短其自由振蕩的時間。
初入寺院那陣子,風(fēng)影一天到晚哭個不停,還滿地打滾,一刻也不曾消停過。他又哭又鬧,皆因他不能跟紅琴一起玩,一起過家家,還不能與那些小動物在一起,用各種怪誕的方法將它們殺死。后來,師父給了他一根竹笛,那竹孔中能發(fā)出各種奇妙的聲音來,還能模仿各式各樣動物的鳴叫,風(fēng)影突然不哭不鬧了,他愛上了吹笛子。
1.5 電子指南針模塊
GY—26是一種低成本平面數(shù)字羅盤模塊,輸入電壓低,功耗小,體積小。其工作原理是通過磁傳感器中兩個相互垂直軸同時感應(yīng)地球磁場的磁分量,從而得出方位角度,此羅盤以RS—232協(xié)議,及IIC協(xié)議與其他設(shè)備通信,具有重新標(biāo)定的功能,能夠在任意位置得到準(zhǔn)確的方位角,其輸出的波特率是9 600 bps,有連續(xù)輸出與詢問輸出兩種方式,具有磁偏角補(bǔ)償功能。當(dāng)小車在行車道上運(yùn)行時,設(shè)定一參考角度,即連續(xù)測量并記錄下每個轉(zhuǎn)彎標(biāo)志線處超車標(biāo)志線的角度,當(dāng)小車行至轉(zhuǎn)彎標(biāo)志線處,按預(yù)設(shè)的角度轉(zhuǎn)彎。
1.6 無線通信模塊
系統(tǒng)采用SRWF—1021無線數(shù)據(jù)傳輸模塊,能適應(yīng)任何標(biāo)準(zhǔn)或非標(biāo)準(zhǔn)的用戶協(xié)議。且微功率發(fā)射,最大發(fā)射功率10 dBm(433/470 MHz)和5 dBm(868/915 MHz),載波頻率可提供433,470,868,915 MHz 4種選擇,高抗干擾能力和低誤碼率。基于GFSK/FSK的調(diào)制方式,采用高效前向糾錯信道編碼技術(shù),提高了數(shù)據(jù)抗突發(fā)干擾和隨機(jī)干擾的能力。傳輸距離遠(yuǎn),便于移動小車直接通信。
2.1 智能小車的主程序
智能小車系統(tǒng)功能的執(zhí)行由指令控制,控制指令既可以由傳感器送出下達(dá),也可以由下位機(jī)面板上的按鍵控制,主程序軟件設(shè)計(jì)流程圖如圖2所示。
圖2 主程序流程圖Fig 2 Flow chart of the main program
通過無線通信模塊使2輛智能車同時啟動,當(dāng)灰度傳感模塊檢測到黑色線時開始轉(zhuǎn)彎,并計(jì)數(shù),即檢測到的黑線個數(shù)為N。轉(zhuǎn)彎通過電子指南針來控制,邊走邊轉(zhuǎn),到轉(zhuǎn)過的角度為90°時,直走,以后重復(fù)該過程。當(dāng)乙車計(jì)到N=8時,乙車通過無線通信模塊給甲車發(fā)信號通知其要超車。以后重復(fù)以上過程。
2.2 行車線路識別模塊程序
小車識別轉(zhuǎn)彎標(biāo)志線后,沿行車道方向直行向前,并由指南針校正方向,使得小車行駛方向與標(biāo)志線成90°。兩個紅外收發(fā)對管放在灰度傳感器兩側(cè),用于檢測行車道邊界線,避免行駛過程中超出邊線。五灰度傳感器放在小車的前方,用于識別轉(zhuǎn)彎線和超車線。行車線路識別模塊流程圖如圖3所示。
圖3 行車線路識別模塊流程圖Fig 3 Flow chart of lane identification modue
2.3 避障超車模塊
灰度傳感器檢測行車道邊線,兩車在行駛過程中由超聲波傳感器判斷前方是否有障礙物,以防兩車相撞。避障超車模塊流程圖如圖4所示,當(dāng)兩車運(yùn)行一圈之后,在第二圈要完成超車的功能。小車通過車頭的紅外傳感器檢測黑線來確定自身位置,當(dāng)在第二圈且檢測到黑線數(shù)為14時,表明小車進(jìn)入到超車區(qū)。前一輛小車轉(zhuǎn)彎后停止2 s,通過定時器實(shí)現(xiàn),后車通過超車道實(shí)現(xiàn)超車。同時在運(yùn)行的過程中,通過超聲波系統(tǒng)來控制兩車的車距,避免兩車相撞。
圖4 避障超車模塊流程圖Fig 4 Flow chart of obstacle voidance module
測試時,將小車放置場地起跑線,保證車頭方向與起跑線平行,啟動小車,按下小車電源按鈕,紅色指示燈點(diǎn)亮,系統(tǒng)初始化成功,代表小車成功啟動。
3.1 功能測試
1)第一組測試:甲車和乙車分別從起點(diǎn)標(biāo)志線開始,在行車道各正常行駛一圈,當(dāng)檢測到第一個轉(zhuǎn)彎以后,兩輛小車可以順利轉(zhuǎn)動90°,平穩(wěn)跑完一圈。
2)第二組測試:甲、乙兩車按圖5所示甲乙兩輛各自的起跑線位置同時起動,乙車通過超車標(biāo)志線后在超車區(qū)內(nèi)實(shí)現(xiàn)超車功能,并先于甲車到達(dá)終點(diǎn)標(biāo)志線,即第一圈實(shí)現(xiàn)乙車超過甲車,最后停在起始的位置,行駛時間為12.6 s,完成設(shè)計(jì)的基本要求。
圖5 智能小車行車道Fig 5 Smart car lane
3)第三組測試:甲、乙兩車?yán)^續(xù)行駛第二圈,甲車通過超車標(biāo)志線后要實(shí)現(xiàn)超車功能,并先于乙車到達(dá)終點(diǎn)標(biāo)志線,即第二圈完成甲車超過乙車,實(shí)現(xiàn)了交替領(lǐng)跑。甲、乙兩車在第二圈行駛的時間要盡可能的短。甲、乙兩車?yán)^續(xù)行駛第三圈和第四圈,并交替領(lǐng)跑;兩車行駛的時間要盡可能的短。在完成上述功能后,重新設(shè)定甲車起始位置(在離起點(diǎn)標(biāo)志線前進(jìn)方向40 cm范圍內(nèi)任意設(shè)定),實(shí)現(xiàn)甲、乙兩車四圈交替領(lǐng)跑功能,行駛時間約50 s。
3.2 測試結(jié)果分析
甲車和乙車分別從起點(diǎn)標(biāo)志線開始,在行車道各正常行駛一圈。當(dāng)甲、乙兩車從起點(diǎn)位置同時起動,乙車通過超車標(biāo)志線后在超車區(qū)內(nèi)實(shí)現(xiàn)超車功能,并先于甲車到達(dá)終點(diǎn)標(biāo)志線,即第一圈實(shí)現(xiàn)乙車超過甲車,最后停在終點(diǎn)位置。甲、乙兩車?yán)^續(xù)行駛第二圈,完成甲車超過乙車,實(shí)現(xiàn)了交替領(lǐng)跑。甲、乙兩車?yán)^續(xù)行駛第三圈和第四圈,并交替領(lǐng)跑,行駛時間約12 s。在完成上述功能后,重新設(shè)定甲車起始位置,實(shí)現(xiàn)甲、乙兩車四圈交替領(lǐng)跑功能。小車只在超車區(qū)進(jìn)行超車,實(shí)現(xiàn)超車后能返回行車道。
通過對樣機(jī)進(jìn)行了測試,結(jié)果表明:無人駕駛智能小車可以實(shí)現(xiàn)單車?yán)@圈行駛、兩車防撞前后行駛、兩車在規(guī)定區(qū)域完成超車等功能,且其性能穩(wěn)定、抗干擾性強(qiáng),在無人駕駛系統(tǒng)方面得到廣泛應(yīng)用。
[1] 梁明亮,孫逸潔.嵌入式智能小車的設(shè)計(jì)與實(shí)現(xiàn)[J].制造業(yè)自動化,2012,34(22):87-89,94.
[2] 趙 津,朱三超.基于Arduino單片機(jī)的智能避障小車設(shè)計(jì)[J].自動化與儀表,2013,28(5):1-4.
[3] 寧慧英.基于光電傳感器的智能小車自動尋跡控制系統(tǒng)[J].儀表技術(shù)與傳感器,2012(1):108-110.
[4] 董宗祥,石紅瑞,楊杰.嵌入式智能小車測控系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)[J].計(jì)算機(jī)測量與控制,2010(2):357-359,362.
[5] 張 洪,錢 勝,陳 路.多傳感器在確定智能小車安全區(qū)域中的應(yīng)用[J].傳感器與微系統(tǒng),2013,32(12):145-148,152.
[6] 劉金強(qiáng),聶詩良,潘澤友,等.基于多傳感器數(shù)據(jù)融合的智能小車避障的研究[J].傳感器與微系統(tǒng),2010,29(2):66-68.
[7] 李新科,高 潮,郭永彩,等.基于語音識別和紅外光電傳感器的自循跡智能小車設(shè)計(jì)[J].傳感器與微系統(tǒng),2011,30(12):105-108.
Design of control system for smart car
XIE Meng, GUO Xia
(Xi’an Jiaotong University City College,Xi’an 710018,China)
A smart car is designed based on 16 bit low power consumption MCU MSP430F5438 as control core,DC motor as driving power,and uses pulse width modulation(PWM)mode to achieve accurate control of speed;use gray sensor to detect the start/finish line and turn/overtaking sign line;using ultrasonic sensor to measure distance in the overtaking area between two cars,and track overtaking area for overtaking;overtaking communication between two vehicles using wireless communication module,which effectively avoid the collision between two cars and smoothly realize overtaking;with electronic compass module for precise positioning and turning control of the two car.The results show that smart car can achieve functions of cycling criterion driving;driving two car crashes before and after,two vehicles in the specified area complete overtaking.The control system has stable performance,strong anti-interference.It has a broad application in the field of driverless control system.
photoelectric sensors; ultrasonic sensors; electronic compass; wireless communication
10.13873/J.1000—9787(2016)12—0110—03
2016—10—19
TP 212.9
A
1000—9787(2016)12—0110—03
謝 檬(1982-),女,陜西西安人,工學(xué)碩士,講師,主要從事測控技術(shù)與儀器及智能儀器的設(shè)計(jì)工作。