基于北斗自主巡航多功能機(jī)器人設(shè)計

惠州學(xué)院電子信息與電氣工程學(xué)院 黃宏越 姚文樹 賴家民 汪成龍

基于北斗自主巡航多功能機(jī)器人設(shè)計

惠州學(xué)院電子信息與電氣工程學(xué)院 黃宏越 姚文樹 賴家民 汪成龍

設(shè)計一款基于KL26的北斗自主巡航多功能機(jī)器人,該機(jī)器人通過北斗實時定位、WiFi通訊控制、超聲波避障以及陀螺儀確定轉(zhuǎn)向等方式，實現(xiàn)機(jī)器人按照一定路線自主巡航的功能，同時設(shè)計一款遙控APP以控制機(jī)器人。本文先對機(jī)器人的功能等情況進(jìn)行概述，然后分別系統(tǒng)的介紹硬件設(shè)計和軟件設(shè)計，最后通過實地測試驗證了本設(shè)計的可行性。本設(shè)計為安防、運輸領(lǐng)域提供智能化的

KL26北斗；WiFi；超聲波；九軸加速度計陀螺儀

1. 前言

隨著人工智能時代的來臨，機(jī)器人的應(yīng)用領(lǐng)域也將越來越廣泛。本文基于安防領(lǐng)域設(shè)計了一款能夠通過北斗定位的自主巡航機(jī)器人。該機(jī)器人以KL26為主控芯片，通過北斗模塊實時定位，通過WiFi模塊連接手機(jī)APP獲取控制，通過超聲波模塊避障，通過九軸加速度計陀螺儀模塊確定車轉(zhuǎn)向，從而實現(xiàn)機(jī)器人按照一定路線自主巡航的功能。同時在已有24V電源的基礎(chǔ)上，增加備用電源,保證機(jī)器人的可靠運行。

2. 硬件設(shè)計

本系統(tǒng)硬件以KL26為主控芯片，外圍電路包含：超聲波模塊、北斗模塊、9軸加速度陀螺儀模塊、wif i模塊等。它們分別通過GPIO、UART0、IIC2和UART2與KL26相連系統(tǒng)。系統(tǒng)硬件框圖如圖1所示：

圖1 硬件框圖

（1）主控芯片：北斗自主巡航多功能機(jī)器人硬件使用KL26單片機(jī)作為核心控制器。KL26是采用Kinetis L系列內(nèi)核，主頻48MHZ，內(nèi)置128K Flash。同時具有運行速度快、功耗低的優(yōu)勢，非常適合作為本設(shè)計的主控芯片。

（2）超聲波模塊：采用HC-SR04超聲波測距模塊，其工作原理為：采用IO口TRIG觸發(fā)測距，提供的高電平信呈最少為10us ；模塊自動發(fā)送8個40kHz的方波測試信號；有信號返回，通過IO口ECHO輸出高電平，高電平持續(xù)的時間就是超聲波從往返時間。

（3）北斗模塊：采用雙系統(tǒng)導(dǎo)航/授時模塊，默認(rèn)波特率為9600bps。使用Unicore協(xié)議，所有消息都以’$’開頭，后面跟著消息名，之后為不定數(shù)量的數(shù)據(jù)與參數(shù)，以逗號隔開，最后的參數(shù)是可選校驗和，以’*’隔開。輸入消息以’ ’或’ ’結(jié)束,輸出消息以’ ’結(jié)束，每條消息不超過256個字節(jié)，不區(qū)分大小寫[1]。

（4）九軸加速度計陀螺儀模塊：模塊含有：MPU-6050、傳感器、電子羅盤。默認(rèn)波特率為115200 bps。模塊發(fā)送至上位機(jī)的每幀數(shù)據(jù)分為3個數(shù)據(jù)包，分別為加速度包、角速度包和角度包，按照三個數(shù)據(jù)包順序輸出[2]。

（5）WiFi模塊：本設(shè)計采用ESP8266串口WiFi模塊，它有3種工作模式。其中，AP模式下模塊相當(dāng)于路由器，只要手機(jī)連接上就能傳送數(shù)據(jù)，簡單快捷，故采用AP 模式。

3. 軟件設(shè)計

北斗自主巡航多功能機(jī)器人軟件設(shè)計分為：機(jī)器人控制系統(tǒng)軟件設(shè)計和遙控APP設(shè)計。其中機(jī)器人控制系統(tǒng)軟件設(shè)計包含：WiFi模塊、超聲波模塊、北斗導(dǎo)航模塊，此外還有KL26及其外設(shè)初始化編程。遙控APP的設(shè)計實現(xiàn)了對機(jī)器人運動控制。

3.1 控制系統(tǒng)設(shè)計

機(jī)器人控制系統(tǒng)軟件設(shè)計是基于keil uvision4為編程平臺。編程過程中利用主程序調(diào)用子程序的方式，設(shè)置了初始化子程序、運動控制子程序等。流程圖如圖2所示：

控制軟件設(shè)計首先對顯示模塊、九軸加速度計陀螺儀模塊、WiFi模塊、北斗模塊進(jìn)行初始化。初始化完成后，每隔20ms執(zhí)行一個任務(wù)，每個模塊對應(yīng)一個任務(wù)，即每個時間段只有一個模塊在工作。在第一個20ms時，接收超聲波模塊的外部中斷，開啟定時器，測車與障礙物的距離等；在第二個20ms時，接收北斗的數(shù)據(jù)，定位當(dāng)前巡邏車的位置，判斷有無越出預(yù)定路徑，運算處理各種情況；第三個20ms時，接收9軸模塊的數(shù)據(jù)，確定當(dāng)前巡邏車的方向，結(jié)合上一個20ms的定位數(shù)據(jù)，確定接下來巡邏車的方向。wifi模塊則一直處于監(jiān)聽狀態(tài)，且優(yōu)先級最高，一旦切換為手動模式，即刻停止。

圖2 程序流程圖

3.2 遙控APP設(shè)計

遙控APP設(shè)計的界面分為：主界面、手動模式界面與自動模式界面，主界面采用“ip地址+端口號”的驗證方式，如圖3所示：

圖3 主界面

當(dāng)機(jī)器人運行時，在主界面輸入WiFi模塊對應(yīng)的“ip地址+端口號”就能聯(lián)網(wǎng)成功，并能選擇自動模式或手動模式。當(dāng)與機(jī)器人聯(lián)網(wǎng)成功后，機(jī)器人接受APP發(fā)送的指令字符串。APP與機(jī)器人使用我們設(shè)計的通訊指令表，如表1所示。

4. 系統(tǒng)測試

調(diào)試過程分為三個步驟：測試各分模塊的功能是否正常，焊接和測試都分模塊進(jìn)行；硬件和軟件測試，測試兩者之間的協(xié)調(diào)性；微調(diào)各種參數(shù)，使系統(tǒng)能按預(yù)期運行。

完成設(shè)計之后，讓機(jī)器人按照預(yù)先設(shè)定路線行走。機(jī)器人能夠按照路線到達(dá)每個定點附近，定點的航線偏差在0-3.5m,符合北斗模塊4m精度。同時機(jī)器人也能很好避障，接受APP控制。因此本設(shè)計的測試結(jié)果滿足設(shè)計預(yù)期，具有一定的實用性。

表1 控制指令表

5. 結(jié)語

本文基于北斗導(dǎo)航系統(tǒng)，設(shè)計履帶式自主巡航多功能機(jī)器人。經(jīng)過測試，該設(shè)計可以按照既定路線進(jìn)行自主移動，在偶遇障礙物時能自動避障且逐步回到已設(shè)軌道，同時可以接受手機(jī)APP遙控，在電池電量不充足的情況下能利用繼電器進(jìn)行電池切換。但由于北斗模塊精度缺陷，有時存在著偏離路線的現(xiàn)象。因此該多功能機(jī)器人更適合在露天、信號通暢的場地巡航。

[1]龔江昆,達(dá)風(fēng).BD/GPS雙模衛(wèi)星通用導(dǎo)航模塊的設(shè)計與實現(xiàn)[J].四川兵工學(xué)報,2015(06):109-112.

[2]任曉文.船舶搖擺速度對風(fēng)向風(fēng)速測量影響的研究[D].大連海事大學(xué),2014.

汪成龍【通訊作者】（1986—），男，湖北人，教師，主要從事機(jī)器視覺等教學(xué)與科研工作。

黃宏越（1995—），男，廣東揭陽人，大學(xué)本科，研究方向：智能控制。

姚文樹【同為第一作者】（1994—），男，廣東汕頭人，大學(xué)本科，研究方向：智能控制。

賴家民（1995—），男，廣東茂名人，大學(xué)本科，研究方向：智能控制。