摘 要: 設計方案以MSP430單片機為系統的控制核心,采用反射式光電傳感器模塊尋跡,實現智能小車的自動尋跡行駛。在實驗中采用與白色相差很大的黑色引導線作為智能小車的既定路線,系統驅動采用控制方式為PWM的直流電機。詳細介紹了反射式光電傳感器尋跡模塊的工作原理,尋跡模塊的電路圖以及在以MSP430單片機為控制核心的基礎上如何實現智能尋跡小車的自動尋跡行駛。并簡要介紹了系統的電路圖。該技術可用于無人生產線、服務機器人、倉庫等領域。
關鍵詞: 智能小車; MSP430; 反射式光電傳感器; PWM
中圖分類號: TN911.7?34 文獻標識碼: A 文章編號: 1004?373X(2013)13?0105?03
Research on MSP430?based tracing module for smart cars
ZHENG Hui
(College of Electronic Engineering, Heilongjiang University, Harbin 150080, China)
Abstract: Smart car automatically tracing traveling is realized by taking MSP430 microcontroller as the control core of the system, and using the reflective photoelectric sensor module for tracing. In the experiment, black guide line far different from white one is taken as the established way for the smart car, DC motor with PWM control is used for system driver. The detail of the work principle of the reflective photoelectric sensor tracing module, the circuit diagram of the tracing module and how to realize the tracing of the car automatically on the basis of taking MSP430 as the control core are given. The circuit diagram of the system is briefly introduced. The technology could be applied in unmanned production line, service robots and warehouse.
Keywords: smart car; MSP430; reflective photoelectric sensor; PWM
0 引 言
智能小車又稱輪式移動機器人,能夠按預設模式在特定環境中自動移動,無需人工干預,可用于科學勘測、現代物流等方面。針對路面采用黑色標記線條作為路徑引導線的應用場合,反射式光電傳感器是常用的路徑識別傳感器。反射式光電傳感器因信號處理方式和物理結構簡單的特點而被廣泛應用于結構化環境和低成本產品中,雖然存在檢測距離近、預測性差的弱點,但通過合理設計和選擇反射式光電傳感器并結合合適的信息處理軟件能夠滿足上述簡單環境場合應用[1]。隨著汽車ECU電子控制的發展,在汽車上配備遠程信息處理器,傳感器和接收器,通過這些器件的協調控制可以實現汽車的無人駕駛[2]。本文提出基于MSP430單片機的控制裝置,通過反射式光電傳感器尋跡,MSP430單片機處理反射式光電傳感器檢測到的信號,從而控制智能車的轉向,實現智能小車的自動尋跡。
1 系統總體設計方案
在小車車體的前端貼近地面的地方安裝有4組尋跡模塊,如圖1所示,單片機通過判斷4個尋跡模塊發送來的信號進行自動循跡[3]。尋跡模塊在遇到黑線時發送低電平信號,遇到空白的地方發送高電平信號,單片機通過判斷高低電平即可作出相應的操作。通過4組尋跡模塊發送的信號組合,可將小車行駛狀態分成如表1所示7種狀態。
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\36t1.tif>
圖1 循跡模塊示意圖
單片機通過判斷當前的運行狀態,然后對L298驅動模塊進行相應的操作。當正常時,不進行調整;當左偏時,通過對L298驅動模塊進行調整,使小車的左輪速度大于右輪速度,即可實現小車向右調整。由于左偏有三種情形,但每種情形只是使能端的PWM參數不同。當右偏時,處理流程與左偏類似[4]。
2 尋跡模塊的硬件設計
繪制完成的反射式光電傳感器電路圖如圖2所示。該電路的工作原理為:當光耦TCRT5000有光線反射回來,即遇到白色等反光能力強的跑道,放大器LM324AD的輸出端輸出為高電平,反之,輸出為低電平。單片機通過控制LM324AD的輸出端電壓即可做出相應的控制操作。四個相同的此模塊分別與單片機的P41,P42,P43,P44引腳相連[5]。單片機模塊如圖3所示。
表1 小車行駛狀態
[尋跡模塊\A\B\C\ D\小車運行狀態\狀態1\低\高\高\高\右大偏\狀態2\低\低\高\高\右中偏\狀態3\高\低\高\高\右小偏\狀態4\高\高\高\高\正常\狀態5\高\高\低\高\左小偏\狀態6\高\高\低\低\左中偏\狀態7\高\高\高\低\左大偏\]
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\36t2.tif>
圖2 尋跡模塊電路
3 循跡模塊的軟件設計
在小車的自動控制模式下,單片機通過判斷4個尋跡模塊發送回來的不同信號進行相應的操作。整體的思路為:小車左偏則左輪的速度要大于右輪的速度小車才能恢復正常,小車右偏則右輪的速度要大于左輪的速度小車才能恢復正常,當小車正常時兩側輪子的速度相同[6]。由上面的分析可知速度的快慢可通過對L298使能端PWM值的控制進行調節。通過多次調試可得出如表2所示的PWM數值。
表2 PWM數值
[狀態\左輪PWM值\右輪PWM值\1 右大偏\88\60\2 右中偏\84\55\3 右小偏\80\50\4 正 常\60\65\5 左小偏\55\80\6 左中偏\50\84\7 左大偏\60\88\]
4 MCU控制與算法實現
系統控制由微處理器完成,微處理器采用MSP430單片機,當單片機讀入傳感器的信號后即可判斷小車當前的行駛狀態[7],具體流程如圖4所示。
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\36t4.tif>
圖4 程序流程圖
5 系統設計
本文設計的智能小車尋跡系統的電路如圖5所示。其中U1、U5、U7、U8分別為反射式光電傳感器A、B、C、D,布局如圖5所示,負責采集軌道信息。U6為L298驅動模塊,負責控制智能小車兩側直流電機[8?9]。
6 結 語
通過對智能車尋跡模塊的研究,分析MSP430單片機的應用,利用感光傳感器信息來控制智能車的自動轉向,實現了智能車的自動尋跡。該尋跡系統的工作流程可概括為:通過四個外置的反射式紅外線傳感器收集軌道信息,在通過微處理器對采集到的信息進行處理,然后將處理后的信息通過PWM信號傳遞給L298驅動模塊,L298模塊根據接收到的軌道信號控制智能車兩側直流電機的運行狀態,最終達到尋跡的目的。智能車在軍事、工業和民用領域的實際應用中,涉及到如何構造完整的導航系統以及多種傳感器數據融合及控制算法等,這需要在實踐中不斷研究探索。
參考文獻
[1] 寧慧英.基于光電傳感器的智能小車自動尋跡控制系統[J].儀表技術與傳感器,2012(1):108?110.
[2] 申偉,孟祥光.基于AVR單片機的車用模型方向控制裝置研究[J].河北交通職業技術學報,2011,8(1):22?25.
[3] 吳建平,殷戰國,曹思榕,等.紅外反射式傳感器在自主式尋跡小車導航中的應用[J].中國測試技術,2004,7(3):93?98.
[4] 陳暉,張軍國,李默涵,等.基于STC89C52和nRF24L01的智能小車設計[J].現代電子技術,2012,35(17):12?15.
[5] 夏路易.電路板設計教程Protel 99SE[M].北京:北京希望電子出版社,2002.
[6] 董宗祥,石紅瑞,楊杰.嵌入式智能小車測控系統的設計與實現[J].計算機測量與控制,2010,18(2):357?362.
[7] 楊國慶,徐強.基于AVR單片機的尋跡小車設計[J].機電產品開發與創新,2012,25(5):131?135.
[8] 周游,景艷梅,何文學.智能尋跡系統設計[J].儀表技術,2012(3):25?30.
[9] 江思敏,陳明.Protel電路設計教程[M].北京:清華大學出版社,2006.
[10] 王延才.電子線路CAD Protel 99 SE[M].北京:機械工業出版社,2008.