基于三軸加速度傳感器的信息采集智能車

王國軍，劉 霞，殷海雙，龐智輝

（東北石油大學(xué) 黑龍江 大慶 163318）

2011年3月日本福島大地震之后造成的核電站核泄漏事件，讓人觸目驚心，突如其來的災(zāi)禍讓核電站內(nèi)的信息采集工作難以進(jìn)行。雖然信息的采集對于災(zāi)禍的處理和受災(zāi)人員的救治是至關(guān)重要的，但是任何信息的獲取都不能以犧牲自身或者以傷及他人作為代價。如何能夠研發(fā)一種能夠替代人員在惡劣環(huán)境下進(jìn)行信息采集工作的智能移動設(shè)備意義重大。

本文章旨在介紹這樣一項能解決類似問題的設(shè)計，該設(shè)計是對傳統(tǒng)的遙控控制進(jìn)行大膽的創(chuàng)新開發(fā)。利用無線通信方式控制一臺具有信息采集功能的智能小車，智能小車能夠?qū)F(xiàn)場的數(shù)據(jù)信息實時回傳給操控人員，保證了災(zāi)后數(shù)據(jù)處理的及時性，這樣救災(zāi)人員能及時做出反應(yīng)。利用重力感應(yīng)技術(shù)對小車的運行姿態(tài)進(jìn)行控制，可以實現(xiàn)小車的轉(zhuǎn)向、直行、后退等基本運動動作，解放了人類的雙手。解決了在危險環(huán)境下還要派人員進(jìn)行人工信息采集的問題。同時智能小車對于數(shù)據(jù)的采集有很高的準(zhǔn)確性，避免了人為采集數(shù)據(jù)時的一些失誤和隨機(jī)誤差，這樣有了更加準(zhǔn)確的現(xiàn)場數(shù)據(jù)做保障，災(zāi)后的救援和處理效率也會有很大的提高。

1 總體設(shè)計

該設(shè)計系統(tǒng)結(jié)構(gòu)圖如圖1所示，智能采集小車上裝有超聲波傳感器，溫濕度傳感器，煙霧傳感器，人體紅外傳感器和火焰?zhèn)鞲衅鞯葮?gòu)成環(huán)境參數(shù)傳感器[1]用來采集災(zāi)難現(xiàn)場時時的數(shù)據(jù)。在采集到的同時，智能采集小車上的單片機(jī)控制NRF24L01無線模塊[2]將數(shù)據(jù)發(fā)送給數(shù)據(jù)接收端，數(shù)據(jù)接收端通過單片機(jī)的控制將數(shù)據(jù)顯示在液晶顯示屏上。在數(shù)據(jù)接收端可通過三軸加速度傳感器來控制小車的運行動作，也可以給智能采集小車發(fā)送接收的數(shù)據(jù)的反饋。

圖1 系統(tǒng)總體結(jié)構(gòu)圖Fig.1 Structure diagram of the power control unit test system

2 系統(tǒng)硬件設(shè)計

系統(tǒng)硬件[3]主要由單片機(jī)控制電路電路、加速度傳感器電路、無線通訊模塊電路、電機(jī)驅(qū)動電路、TFTLCD顯示屏電路、環(huán)境參數(shù)傳感器電路等組成，系統(tǒng)硬件結(jié)構(gòu)圖如圖2所示。ADXL345加速度傳感器電路主要用來測量手持端傾斜角度輸出車體運動控制信號；LCD顯示屏電路電路主要用來顯示回傳的環(huán)境參數(shù)，無線通訊電路用來進(jìn)行信息傳輸控制；單片機(jī)控制電路用來對智能車的精確控制、處理傳感器采集的環(huán)境參數(shù)及LCD顯示控制；環(huán)境參數(shù)傳感器電路主要由超聲波傳感器、人體紅外傳感器、煙霧傳感器、溫濕度傳感器等構(gòu)成，是一個多種傳感器的集合，主要用來收集智能車所處外界環(huán)境參數(shù)信息發(fā)回終端處理。

圖2 系統(tǒng)硬件結(jié)構(gòu)圖Fig.2 Structure diagram of the hardware system

STM32F103ZET6單片機(jī)控制電路路主要是用來處理回傳數(shù)據(jù)控制信號等，這款單片機(jī)是增強(qiáng)型，32位基于ARM核心的帶512K字節(jié)閃存的微控制器其中有USB、CAN、11個定時器、3個ADC、13個通信接口，最高72 MHz工作頻率，在存儲器的0等待周期訪問時可達(dá)1.25 DMips/MHz（Dhrystone 2.1）[5]，用它其中一個定時器實現(xiàn) PWM信號輸出提供電機(jī)驅(qū)動信號，很好的避免了定時器復(fù)用帶來的多器件之間的沖突。大容量存儲空間不用外加存儲器。各種通訊接口齊全方便外接通訊。來自加速度傳感器的傾斜角度信息傳至單片機(jī)，單片機(jī)將角度信號轉(zhuǎn)換為對應(yīng)的電機(jī)驅(qū)動信號發(fā)給車體CPU，車體CPU將這一信號轉(zhuǎn)化為PWM信號[6]驅(qū)動電機(jī)。來自外界環(huán)境的參數(shù)信息經(jīng)車體CPU處理后經(jīng)無線模塊發(fā)回手持終端由終端CPU再由其處理將信號顯示在LCD顯示屏上。

加速度傳感器電路主要是用來實現(xiàn)手持端遙控車體運動的。操作人員在操作時不必雙手持遙控器操作，只需單手給予一定的傾斜角度就可將角度信號轉(zhuǎn)換為對應(yīng)的電機(jī)控制信號角度關(guān)系與控制信號如表1。

當(dāng)手持設(shè)備端保持水平時A保持輸出Z的1g倍，其他為0，當(dāng)X軸變化時X軸相對于水平面角度發(fā)生變化，角度為負(fù)值時輸出信號控制車體前進(jìn) （電機(jī)1正轉(zhuǎn)，電機(jī)2正轉(zhuǎn)），正值時控制車體后退（電機(jī)1反轉(zhuǎn)，電機(jī)2反轉(zhuǎn)）。同樣Y軸以相同的方式輸出信號控制車體左右運動。

NRF24L01無線通信模塊電路的作用是將手持端發(fā)送的運行控制信息發(fā)給車體或?qū)④圀w收集的環(huán)境參數(shù)信息發(fā)回手持端顯示在LCD上。NRF24L01無線模塊是半雙工的通訊方式，通過SPI方式實現(xiàn)信號的讀寫。

表1 角度與控制信號關(guān)系Tab.1 Relationship between the angle and the control signal

智能車采用一個L298N電機(jī)驅(qū)動模塊來驅(qū)動兩個強(qiáng)磁電機(jī)，通過軟件控制的PWM信號接在模塊ENA，ENB端控制電機(jī)轉(zhuǎn)速達(dá)到控制車速的目的。模塊上IN1，IN2，IN3，IN4接在四個I/O口上控制電機(jī)的正反轉(zhuǎn)實現(xiàn)轉(zhuǎn)彎。運行姿態(tài)與I/O關(guān)系如表2所示。

表2 運行姿態(tài)與I/O關(guān)系Tab.2 Running posture with the I/O relationship

電路圖如圖3所示。

圖中的 T_MISO/T_MOSI/T_PEN/T_CS是用來實現(xiàn)對液晶觸摸屏的控制。LCD_BL則控制LCD的背光，液晶復(fù)位信號RST用來控制復(fù)位。模塊采用16位并行接口方式與CPU連接，這樣數(shù)據(jù)量增大適合彩屏的大數(shù)據(jù)量顯示，DB0～DB17數(shù)據(jù)接口跟12864液晶的P0口類似。

3 系統(tǒng)軟件設(shè)計

該參數(shù)采集系統(tǒng)的軟件采用C語言編程，在程序編輯方面采用Keil μVision4進(jìn)行程序編譯。在軟件設(shè)計過程中采用模塊化的設(shè)計，整個系統(tǒng)由環(huán)境參數(shù)采集模塊、加速度傳感器控制運行姿態(tài)模塊、PWM輸出控制信號模塊、2.4G無線通信模塊和TFT LCD顯示模塊等組成。系統(tǒng)軟件設(shè)計的結(jié)構(gòu)圖如圖5所示。

在軟件設(shè)計中環(huán)境參數(shù)采集模塊主要用來實現(xiàn)對溫濕度、火焰、氣體成分等環(huán)境數(shù)據(jù)的采集；加速度傳感器模塊主要用來實現(xiàn)對手持控制系統(tǒng)中傾斜角度信號到電機(jī)控制信號的轉(zhuǎn)化，通過該模塊可以實現(xiàn)車體運行姿態(tài)的控制；PWM輸出控制信號模塊主要用來實現(xiàn)對電機(jī)驅(qū)動模塊ENA、ENB兩使能端的控制，通過控制單位周期內(nèi)的高低電平占空比已達(dá)到控制電機(jī)轉(zhuǎn)速的目的。2.4G無線通信模塊實現(xiàn)手持終端與信息采集車之間的數(shù)據(jù)交換，并可以根據(jù)。TFT LCD顯示模塊，主要實現(xiàn)回傳參數(shù)的顯示。軟件設(shè)計的流程圖如圖6、圖7、圖8所示。

圖3 電機(jī)驅(qū)動模塊電路圖Fig.3 Motor driver module circuit diagram

圖4 TFT LCD顯示屏電路Fig.4 TFT LCD display

圖5 系統(tǒng)軟件設(shè)計結(jié)構(gòu)圖Fig.5 System software design structure

圖6 信息采集車及手持端總框圖Fig.6 Information collection and handheld extremity block diagram

圖7 環(huán)境參數(shù)模塊及加速度傳感器控制模塊框圖Fig.7 Environmental parameters and acceleration sensor control module the module block diagram

4 實驗應(yīng)用

圖8 PWM輸出控制信號框圖Fig.8 PWM output control signal diagram

該設(shè)計用于實現(xiàn)在復(fù)雜和危險環(huán)境下的數(shù)據(jù)采集工作。在使用該設(shè)計時，操作人員可站在遠(yuǎn)離危險環(huán)境的地方，通過手持設(shè)備也就是數(shù)據(jù)接收設(shè)備上的三軸加速度傳感器來控制小車的前進(jìn)、后退和轉(zhuǎn)彎。當(dāng)小車來到數(shù)據(jù)采集的現(xiàn)場后，可通過超聲波傳感器來進(jìn)行避障以及障礙物距離的傳輸，這樣現(xiàn)場人員就能大概算出災(zāi)難現(xiàn)場空間的大小。溫濕度傳感器能測出災(zāi)難現(xiàn)場的溫度和濕度，從而判斷救援人員能否進(jìn)入。煙霧和火焰?zhèn)鞲衅骺捎脕硖綔y災(zāi)難現(xiàn)場是否存在火情或是濃煙。人體紅外傳感器可以探測到災(zāi)難現(xiàn)場是否有傷員，并且基于上面測到的幾種數(shù)據(jù)，救援人員能夠迅速判斷現(xiàn)場環(huán)境是否適合傷員存活并做出救援方案。

5 結(jié) 論

此研究是對傳統(tǒng)的遙控控制進(jìn)行大膽的創(chuàng)新開發(fā)，利用重力感應(yīng)技術(shù)對小車的運行姿態(tài)進(jìn)行控制，可以實現(xiàn)小車的轉(zhuǎn)向、直行、后退等基本運動動作。實現(xiàn)了操作的無按鍵化，擺脫按鍵的煩惱，操作簡單，更顯人性化；利用無線通信方式進(jìn)行數(shù)據(jù)傳輸，擺脫了有線通信方式，帶來了布線困難，維護(hù)不便等缺點；采用熱門的無線傳感器技術(shù)，屬于物聯(lián)網(wǎng)技術(shù)范疇內(nèi)的一個創(chuàng)新實驗研究，同時也是無人型機(jī)器人發(fā)展方向的一次探索。

[1]童詩白.模擬電子技術(shù)基礎(chǔ)[M].4版.北京.高等教育出版社，2006.

[2]劉泉.通信電子線路[M].2版.武漢.武漢理工大學(xué)出版社，2005

[3]陳梓城.實用電子電路設(shè)計與調(diào)試[M].北京.中國電力出版社，2006.

[4]邱關(guān)源.電路[M].北京.高等教育出版社，2006.

[5]劉軍.例說STM32[M].北京.北京航空航天大學(xué)出版社，2011.

[6]毛勇.控制電機(jī)轉(zhuǎn)速的PID算法綜述[J].機(jī)電信息，2011（6）:43-44.MAO Yong.Summary of PID algorithm to control the motor speed[J].Electrical and Information，2011（6）:43-44.