三軸加速度傳感器在智能車控制與道路識別中的應(yīng)用(共9頁)

1、精選優(yōu)質(zhì)文檔-傾情為你奉上三軸加速度傳感器在智能車控制與道路識別中的應(yīng)用 趙小平 程志江 張永瑞 段志尚摘要：三軸加速度傳感器MMA7260Q可以測量智能車慣性大小，選取最佳重心位置，并能準(zhǔn)確定位智能車處于直線、彎道、坡道、漂移等運行狀態(tài)；利用加速度傳感器能夠提前預(yù)測路徑，并判斷何時剎車效果最佳。并且很好的解決了在直立行走車模的平衡與方向識別。關(guān)鍵詞： 智能車； 加速度傳感器；MMA7260Q；道路識別； 引言：提出了一種基于三軸加速度傳感器在智能車中的控制以及路徑識別的設(shè)計。該設(shè)計采用三軸加速度傳感器MMA7260Q測量智能車在運動中的加速度信號，以嵌入式單片MC9S12XSl28B作為核心

2、控制器，對加速度信號進(jìn)行采樣，AD轉(zhuǎn)換，再將特征數(shù)據(jù)存儲在EEPROM中。很好地解決了智能車運動路徑分析的問題以及在。實時獲取小車加速度，從而更加全面的獲取小車的運行狀態(tài)，為控制的流暢性和更好的路況識別提供了可能。在直立行走的車模中，應(yīng)用同樣的原理，選擇最佳重心，可以很好地解決直立行走車模的平衡以及方向識別，從而加快車模的行車速度。實驗結(jié)果證明：結(jié)合加速度傳感器具有很強(qiáng)的抗干擾性，提取角度信息更準(zhǔn)確，確保了智能車在直道上能夠以較高的速度行駛，在彎道則能基本不失速平滑地過彎。1. 智能車現(xiàn)存問題在車模運行當(dāng)中，人無法判斷小車的運行狀態(tài)，使用加速度傳感器來監(jiān)控小車的加速度，這樣可以更加精確地知道小

3、車的運行狀態(tài)，而且可以通過對某個方向加速度的變化的檢測來區(qū)分出坡道和非坡道。從而進(jìn)行相應(yīng)的策略應(yīng)對。避免小車在比賽時出現(xiàn)停車與翻車現(xiàn)象。以及很好地解決了直立行走的車模中在行走過程中的平衡性。2.MMA7260Q簡介 加速度傳感器是Freescale公司出品的MMA7260Q。圖1 芯片引腳定義2.1M M A 7 2 6 0 Q 的特性：在一個設(shè)備中提供三軸向XYZ檢測靈敏度，可選靈敏度：1.5g、2g、4g 和6g；功耗低，具有休眠模式，低壓運行一般在2.2V3.6V，能夠快速啟動，一般啟動時間為1ms；其低噪音，封裝一般為16針腳6mm x 6mm x 1.45mm無針腳型方體扁平封裝（Q

4、 F N ）。2.2M M A 7 2 6 0 Q 的優(yōu)點為多功能應(yīng)用提供靈活的可選量程：包括1.5g、2g 、4g 和6g ；功耗低，可延長電池使用壽命 開機(jī)響應(yīng)時間短，最適合電池供電手持設(shè)備的休眠模式，組件數(shù)量少-節(jié)約成本和空間噪音低、靈敏度高，具有自適應(yīng)功能，頻率及解析度高，提供精確的墜落、傾斜、移動、放置、震動和搖擺感應(yīng)靈敏度不同應(yīng)用的建議重力加速度級別自由落體檢測：1g2g 傾斜控制：1g2g。2.3加速度傳感器應(yīng)用分析2.3.1干擾因素分析芯片可以測試一個方向上的加速度變化。所以采用了不同的安裝方式，其間要考慮到比較多的干擾因素。一、車體行進(jìn)過程中的機(jī)械振動二、速度控制不平滑對車體

5、運動狀態(tài)的影響三、常規(guī)情況下的誤差和正常時，加速度傳感器產(chǎn)生的輸出區(qū)別大小2.3.2安裝方式分析若安裝于安裝攝像頭的立桿上，桿子在小車加減速的時候有比較明顯的左右晃動，通過Labview觀察發(fā)現(xiàn)干擾過大。若安裝于小車后部，由于電機(jī)自身的振動，對MEMS產(chǎn)生的影響會較之前更為明顯。經(jīng)測試，如果測量水平X方向的加速度，宜將裝有MMA2260的電路板裝載在車前部。Z軸加速度傳感器X軸Y軸車模運行方向圖二 加速度傳感器安裝方式若在直立行走車模上安裝，則要測量豎直Z方向上的加速度。電池加速度傳感器車模運行速度X軸Z軸Y軸圖三 直立行走車模安裝示意圖2.4硬件電路設(shè)計MMA7260Q信號采集模塊設(shè)計加速度

6、信號采集模塊如圖1所示。x，l，z 3個相互垂直方向上的加速度由G-Gell傳感單元感知，電容值經(jīng)過容壓變換器轉(zhuǎn)換為電壓值，經(jīng)過增益放大器、濾波器和溫度補(bǔ)償以電壓的形式作為輸出信號拉J，經(jīng)過放大濾波處理，將所需模擬信號調(diào)整至一個合適的范圍，再轉(zhuǎn)換為數(shù)字信號送數(shù)據(jù)處理單元。A/D轉(zhuǎn)換信號處理三軸加速度傳感器單片機(jī)數(shù)據(jù)處理 圖四 加速度信號采集結(jié)構(gòu)圖加速度傳感器與單片機(jī)的接口電路MMA7260Q與MC9S12XSl28B的硬件接口電路如圖2所示。微處理器內(nèi)部包含完整的地輸入緩存器、模擬開關(guān)電路、可編程增益放大器和AD轉(zhuǎn)換器以及數(shù)字濾波器，使用非常方便。G1，G2輸入低電平，靈敏度達(dá)到800 mVg

7、。當(dāng)Mode=l時，加速度傳感器處于正常工作狀態(tài)。x，y，z輸出端分別接RC濾波器，再通過高輸出驅(qū)動運算放大器TLV4112構(gòu)成電壓跟隨作用，輸出穩(wěn)定的直流電壓信號。圖五 MMA7260Q與MC9S12XSl28B的硬件接口電路2.5軟件設(shè)計實現(xiàn)本設(shè)計采用CodeWamor軟件與BDM作為調(diào)試工具，編程環(huán)境支持c語言和匯編語言的程序設(shè)計，大大方便了用戶的程序設(shè)計，提高了系統(tǒng)開發(fā)效率。本設(shè)計程序代碼使用C語言編寫。系統(tǒng)初始化開始單片機(jī)PWM控制輸出舵機(jī)或(電機(jī))加速度傳感器-0.5g<x(y)<0.5g單片機(jī)單片機(jī)PWM控制輸出舵機(jī)或(電機(jī))PWM控制輸出舵機(jī)(電機(jī))小車左轉(zhuǎn)(加速)

8、-1.5g<=x(y)<= -0.5g0.5g<=x(y)<=1.5g小車左轉(zhuǎn)(勻速)小車左轉(zhuǎn)(減速)圖六 加速度程序流程圖2.6 AD采樣流程設(shè)計本設(shè)計主要包括單片機(jī)初始化模塊和實時路徑檢測模塊。1)單片機(jī)的初始化模塊包括：IO模塊，AD模塊，定時中斷模塊初始化。2)實時路徑檢測模塊：利用接受管，紅外光電傳感器和CCD攝像頭檢測特征信號，利用加速度傳感器檢測角度信號，將返回信號輸入單片機(jī)的輸入端口，程序不問斷地讀入輸入端口的信號，結(jié)合判斷語句，得出合適的PWM控制信號。N單片機(jī)初始化開始定時中斷使能啟動定時器串口發(fā)送程序數(shù)據(jù)處理控制PWM輸出定時器中斷處理保護(hù)現(xiàn)場關(guān)中

9、斷信號采樣，A/D轉(zhuǎn)換i=i+1定時器賦值現(xiàn)場恢復(fù)開中斷返回NY采樣i=10Y圖七 主程序與中斷程序流程圖2.7實驗測試圖中曲線為時間和AD采集到的數(shù)據(jù)之間的關(guān)系。而AD采集到的數(shù)據(jù)可以用來反映加速度的變化情況圖八 裝載于靜止小車上時圖九 裝載于運動狀態(tài)不變小車上時-1.5g1.5gg0 圖十 小車角度變化時通過測試可以看出。對于車體角度的變化，加速度傳感器的值都有一定的變化。不過同時也看到車子的振動對加速度傳感器也會產(chǎn)生一些干擾。在識別坡道時，如果加速度傳感器監(jiān)控的是豎直方向的加速度，即z方的加速度，那么在平道上時，明顯豎直方向上加速度為零，在上坡后，如果忽略摩擦力，那加速度將變化為。通過加

10、速度傳感器中加速度的變化可以容易的辨別出平道和坡道。2.8數(shù)字濾波算法設(shè)計由于加速度傳感器三軸之間差異和較高靈敏度，防止在運動過程中由于智能車的抖動引起的誤差，對單片機(jī)采樣得到的電壓值進(jìn)行歸一化處理，最后可得到各方向傳感器的相對電壓值。具體實現(xiàn)方法：讓智能車后輪轉(zhuǎn)動起來，分別記錄各傳感器輸出信號的最大值和最小值，用最大值減去最小值得到各傳感器在運動過程中的輸出范圍。在智能車行駛過程中將各方向傳感器輸出的信號值減去最小值，再除以各方向傳感器的輸出范圍即可得到其相對輸出值。根據(jù)g1=g2=0，最小值對應(yīng)著-1.5g，最大值對應(yīng)著+15g。，靜止時各向加速度值為0，加速度范圍為-1.5g一+1.5g

11、。2.9路徑識別規(guī)則X-T表示智能車前后方向加速度信號，Y-OUT表示智能車左右方向加速度信號，Z-T表示智能車上下方向加速度信號采樣值經(jīng)過數(shù)字濾波，由于智能車的底盤不可能保持絕對水平，車身可能會向前傾斜或者向后傾斜，所以，Y-OUT，X-UT，Z-OUT值都有5的誤差，當(dāng)處于勻速直線運動時，采樣值在100110之間波動。通過加權(quán)平均近似為105，125對應(yīng)+1.5g， 80對應(yīng)-1.5g。3 結(jié)束語MMA 7260Q是一種電容式加速度傳感器，融合了信號調(diào)理，單極低通濾波和溫度補(bǔ)償技術(shù)。成本低，功耗低，測試中加速度信號穩(wěn)定性與靈敏度都達(dá)到了預(yù)期的效果，從而提高了系統(tǒng)的控制精度，使舵機(jī)響應(yīng)速度變快。 基于三軸加速度傳感器在智能車的控制與路徑識別的設(shè)計，相比傳統(tǒng)的路徑識別具有數(shù)據(jù)處理簡單，控制精度高的特點，使舵機(jī)響應(yīng)變快?？梢詮V泛應(yīng)用與無人駕駛智能車，智能儀表，機(jī)器人等高端技術(shù)領(lǐng)域。 4 參考文獻(xiàn)：1卓晴，黃開勝學(xué)做智能車一挑戰(zhàn)“飛思卡爾”杯M。 北京航空航天大學(xué)出版社，2007。2 蘇維嘉，王旭輝新型加速度傳感器在傾角測量中的應(yīng)用研究J機(jī)械研