基于STM32的避障小車設計

李懷宇

【摘 要】基于超聲波傳感器測距原理和紅外傳感器避障原理，首先提出控制系統的總體方案，其為：前方遇障礙物，小車減速并判斷左側是否有障礙物，無則左轉，有則繼續判斷右側是否有障礙物，無則右轉，有則制動并后退。之后從硬件設計、軟件設計兩方面展開，給出了以STM32單片機為核心、使用L298N驅動電機的避障小車系統的設計。設計的意義在于使用簡單的傳感器進行自動避障，避障方案易于實現且方便移植，其對于開發多功能自動機器人具有借鑒意義，同時它也可以用于智能玩具的開發。

【關鍵詞】STM32；避障小車；超聲波傳感器；紅外傳感器；L298N

中圖分類號：TP242.3 文獻標識碼： A 文章編號： 2095-2457（2018）30-0191-003

DOI：10.19694/j.cnki.issn2095-2457.2018.30.084

The Design of Obstacle Avoidance Car Based on STM32

LI Huai-yu

（College of Automation of Harbin Engineering University，Harbin Heilongjiang 150001 China）

【Abstract】Based on the principle of ultrasonic sensor ranging and infrared sensor obstacle avoidance， the overall scheme of the control system is proposed firstly， which is： encountering obstacles ahead， the car slows down and judges whether there are obstacles on the left side， if there is no left turn， if there is still judgement whether there are obstacles on the right side， if there is no right turn， if there is braking and back.Then the design of obstacle avoidance trolley system based on STM32 MCU and driven by L298N motor is given from two aspects of hardware design and software design. The design significance of the system lies in the use of simple sensors for automatic obstacle avoidance. The obstacle avoidance scheme is easy to implement and easy to transplant. It can be used for reference in the development of multi-functional automatic robots. At the same time， it can also be used in the development of intelligent toys.

【Key words】STM32； Obstacle avoidance car； Ultrasonic sensors； Infrared sensor； L298N

0 引言

隨著科技的快速發展，很多行業都引入了智能化的設備，汽車行業也不例外。智能汽車可以用于碼頭無人操作自動運輸，也可以在人類無法到達的危險環境中作業，其應用前景十分廣闊。避障小車是一種可移動的輪式機器人，可以在無人操縱的情況下自主行走，遇到障礙物可以報警并自動避障。本文設計的避障小車以STM32F103ZET6為主控芯片，以紅外光電傳感器和超聲波傳感器為檢測元件，以直流減速電機為執行元件，它基本滿足了避障對于小車靈活性的要求。

1 控制系統總體方案

避障小車主要由主控模塊、驅動模塊、檢測模塊、報警模塊、顯示模塊、電源模塊六個主要模塊組成，系統結構框圖如圖1所示。具體工作流程：當位于小車前方的超聲波傳感器檢測到障礙物時，將障礙物的距離信號發送至單片機，單片機會對信號進行處理，通過LCD屏幕顯示出來，之后對距離信號進行判斷，若距離大于80厘米，則延續之前的運動；若距離在80到60厘米之間，則輸出控制信號通過驅動模塊使電機轉速下降達到減速的目的；若距離在60厘米以內，則先使后輪減速并迅速判斷安裝在車身兩側的紅外避障傳感器是否檢測到障礙物，如果兩側都無障礙物，單片機發出控制信號使前輪左轉；如果左側有障礙物，前輪右轉；如果兩側都檢測到障礙物，單片機發出控制信號使小車制動并后退。當轉向繞開前方障礙物后，即超聲波檢測出前方80厘米內都沒有障礙物時，前輪擺正。在小車運行過程中，若超聲波傳感器檢測到車頭與前方障礙物的距離低于20厘米時，后輪會緊急制動并后退同時拉響警報[1]。

2 系統硬件設計

2.1 車體框架

避障小車為前兩輪利用直流電機轉向，后兩輪利用直流電機驅動的四輪結構。前輪的轉向同樣可以利用舵機來實現，不過本車使用的電機驅動模塊L298N自帶兩路控制通道，因此為了防止有用資源的浪費和避免引入更多模塊帶來的軟件設計問題，我們仍利用直流電機來實現前輪的轉向功能。四輪車架結構簡單穩定，足以承受上層各模塊的重量。上層模塊的重量主要集中在電源模塊和連接了LCD屏幕的STM32主控板上，應注意將這兩部分安裝在小車四輪的中心靠后兩輪的中線上，以防重心的偏移導致前輪轉向用直流電機出現零位誤差，即直流電機在沒有控制指令的情況下發生偏轉，改變了小車原有的路徑。

2.2 主控模塊

主控模塊的核心是一塊STM32F103ZET6芯片，該芯片是意法半導體公司推出的基于Cortex-M3內核的32位ARM微控制器。芯片具有2個基本定時器、4個通用定時器、2個高級定時器以及112個通用IO口，時鐘頻率達到72MHz，各種參數足以滿足小車運行對主控芯片的要求，且其價格低廉，開發成本低，因此我們選擇了該款芯片。

2.3 電機驅動模塊

2.3.1 驅動原理

驅動模塊使用的驅動芯片為L298N雙H橋直流電機驅動芯片，驅動電路原理圖如圖3所示。L298N為SGS公司生產的專門用于驅動二相和四相電機的驅動器。它擁有四通道邏輯電路，內含兩個H橋高電壓大電流雙全橋式驅動器，接收標準TTL邏輯電平信號。其上的四個端子IN1、IN2、IN3、IN4可以通過輸入高低電平來控制電機A和電機B的正反轉，具體組合方式如表1所示。端子ENA和ENB是使能端，可以接收來自單片機的PWM波進行調速。當使能信號為0時，電機處于自由停止狀態；當使能信號為1時，配置IN所接單片機的相應引腳才可以使電機處于正轉、反轉、制動狀態[2]。

2.3.2 驅動方式的選擇

后輪電機的作用是驅動車輛，通過配置IN1和IN2來控制其運動狀態，小車的運動過程需要加速和減速，因此還需對ENA引腳輸入PWM波進行調速操作。前輪電機的作用是轉向，電機的運動幾乎是瞬間完成的，因此不需要對電極進行調速操作，僅使能ENB再對IN3和IN4進行高低電平配置即可。

2.3.3 注意事項

主控板應和L298N共地，否則高低電平的判斷無法實現，即使線路連接和程序沒有問題，電機也不會正常運轉。

2.4 超聲波測距模塊

超聲波模塊固定在小車的正前方，用來檢測正前方的障礙物。在這里筆者選用的型號是US-100，其測距范圍為2cm-450cm，自帶溫度傳感器可以自動對測試結果進行校正，具有電平輸出和UART輸出兩種輸出方式，小車使用的是電平輸出。該模塊具有五個端子，1號端子接VCC電源；4號和5號端子接外部電路的地；2號端子為Trig端；3號端子為Echo端。需要測距時，單片機會從Trig管腳輸入一個10微秒以上的高電平，系統會發出8個40KHz的超聲波脈沖，然后檢測回波信號，經過溫度校正后，將結果通過Echo管腳輸出[3]。

2.5 紅外避障模塊

紅外避障模塊固定在小車的兩側，一側使用一個，用來判斷左右兩側是否有障礙物。當前方出現障礙物時，紅外傳感器的信號線中的電平由高置低，通過讀取與信號線連接的單片機上的相應IO口的低電平即可判斷出出現障礙物[4]。市面上的大部分紅外傳感器對外界的光干擾比較敏感，鑒于小車可能會在強光中運行，因此選擇型號為HJ-IR2的紅外傳感器。其主要優點是抗光干擾能力強，檢測距離為2cm-30cm。

2.6 蜂鳴器電路

單片機的IO口驅動能力不足以使蜂鳴器發聲，因此我們通過三極管放大驅動電流來使其發聲。當單片機輸出高電平時，三極管導通，集電極電流通過蜂鳴器使之發出聲音。

2.7 電源模塊

本次設計中使用的是兩節3.7伏可充電電池串聯供電，供電電壓為7.4伏，直接給L298N供電。另引出一路電源通過降壓模塊降壓至5伏給主控板供電，降壓模塊上有數碼管可以實時監測電源電壓，當電壓不足時需要及時充電[5]。主控板上自帶ASM1117芯片，可以將5伏電壓轉換為3.3伏。

2.8 LCD顯示模塊

本次設計中為了使調試工作比較方便，特意加入了LCD顯示模塊來顯示超聲波所測距離。LCD屏幕連接在主控板上。

3 系統軟件設計

在本次設計中筆者使用C語言進行編程，在編程過程中使用了模塊化設計，方便移植。編譯軟件使用的是KeilμVision5，該款軟件擁有功能強大的仿真調試器，便于檢查錯誤。

3.1 主程序

先引用頭文件，之后對各項定義的函數進行初始化，輸出占空比為零的PWM波控制后輪進行啟動，對超聲波發送持續10微秒以上的高電平使它開始檢測。若前方障礙物距離低于80厘米，將具體距離值顯示在LCD屏幕上，并進一步判斷：如果距離在60厘米到80厘米之間，輸出一定占空比的PWM波使小車減速；如果距離在20厘米到60厘米之間，先減速再判斷左側紅外傳感器的信號結果，若為高電平即無障礙物則左轉，轉彎過程中每200微秒檢測一次前方障礙物距離，當前方障礙物距離大于80厘米時前輪擺正；若為低電平則繼續判斷右側是否有障礙物，無則右轉，有則通過改變電機驅動IN1和IN2的配置使小車后退，延時一秒后重新判斷障礙物距離；如果距離在20厘米以內，則使能相應IO口使蜂鳴器發聲并使小車后退，延時一秒后重新判斷障礙物距離。主程序流程圖如圖7所示。

圖7 主程序流程圖

3.2 定時器程序

STM32的通用定時器既可以用于測量輸入信號的脈沖長度即輸入捕獲，也可以用于產生輸出波形即輸出比較和PWM波。STM32的通用定時器之間不會互相干涉，都是完全獨立的。

3.2.1 輸入捕獲

超聲波的信號回傳使用了輸入捕獲。其信號線與單片機相連，配置單片機的相應引腳為輸入捕獲，先使用上升沿捕獲來檢測信號，記錄發生上升沿的定時器的值，之后配置該引腳為下降沿捕獲，當捕獲到下降沿時再記錄一次定時器的值，兩值相減便是高電平脈寬。當然如果脈寬過長，沒檢測到下降沿時定時器已經溢出，則還需要額外對定時器溢出的次數進行計數才可以得到準確的高電平脈寬[6]。當測出脈寬為t時，將t乘以聲速（帶溫度補償的US-100傳感器聲速直接使用340m/s）再除以2（所測時間t為超聲波被發出碰到障礙物再彈回被接收的總時長）即為所測距離。

3.2.2 輸出PWM波

對后輪電機的速度調節使用的是PWM波，通過調節PWM波的占空比改變電機通斷電時間從而達到調速的目的[6]。

4 結束語

本文簡述了以STM32單片機為核心的避障小車系統的設計，包含了電機驅動模塊、超聲波模塊、紅外模塊等。本系統的設計意義在于使用簡單的傳感器進行自動避障，避障方案易于實現且方便移植，其對于開發多功能自動機器人具有借鑒意義，同時它也可以被用于智能玩具的開發。預留的LCD屏幕可以顯示小車更多的狀態，方便開發者對小車功能的進一步開發，比如給小車安裝無線手柄進行人為遙控，并使用無線模塊將小車狀態通過單片機之間的通信顯示在另一單片機的LCD屏幕上。

【參考文獻】

[1]嵇萍.基于單片機的自動避障小車設計[J].蘇州市職業大學學報，2013， （1）：33-35.

[2]冷雪鋒.基于PID的STM32智能小車機器人的設計[J].自動化技術與應用，2016，第35卷（11）：122-127.

[3]馬巧梅.基于51單片機的汽車預警系統的設計與實現*[J].自動化技術與應用， 2017，第36卷（11）：121-124.

[4]代德丹，王猛，李怡.智能避障小車[J].電子世界，2017，（20）：111-112.

[5]胡海.基于單片機的自適應避障小車的設計[J].微型電腦應用，2017，第33卷（4）：45-47.

[6]張洋，劉軍.原子教你玩STM32（庫函數版）（第二版）[M].北京：北京航空航天大學出版社，2015.