一種小型水質監(jiān)測無人船控制系統(tǒng)設計

劉瑞 丁 浩 胡亞偉 李銘盛 吳順達

摘 要：無人船在水質檢測、采樣、巡邏等方面有著廣闊的應用前景。針對無人船傳輸數(shù)據(jù)實時性差的問題，利用4G網(wǎng)絡結合數(shù)據(jù)傳輸模塊進行無人船與控制中心之間的數(shù)據(jù)傳輸;針對具有自主能力的無人船造價昂貴的問題，以樹莓派為控制中心設計無人船控制系統(tǒng)，實現(xiàn)無人船的自動巡航;針對無人船無法自動處理突發(fā)情況的問題，采用移動端、遙控器、服務器端多端控制的方法;針對無人船適應環(huán)境能力較差的問題，采用PID算法進行無人船的航向控制。實驗結果表明，該算法可實現(xiàn)無人船的多端控制、數(shù)據(jù)實時傳輸與自動巡航功能。

關鍵詞：無人船;樹莓派;多端控制;控制系統(tǒng)

DOI：10. 11907/rjdk. 182846 開放科學（資源服務）標識碼（OSID）：

中圖分類號：TP319文獻標識碼：A 文章編號：1672-7800（2019）008-0119-04

Design of a Small Water Quality Monitoring Unmanned Ship Control System

LIU Rui1，DING Hao1，2，HU Ya-wei1，LI Ming-sheng1，WU Shun-da1

（1. School of Computer Science and Technology， Nantong University;

2. Nantong Research Institute for Advanced Communication Technologies， Nantong 226019，China）

Abstract：Unmanned boat has broad application prospects in water quality testing， sampling and patrol. In view of the problem that the unmanned ship with autonomy is expensive， the unmanned ship control system is designed with the Raspberry Pi as the control center， and the unmanned ship's autonomous obstacle avoidance is adopted by the angle potential field method. In the case that the situation cannot be handled automatically， the mobile terminal， the remote controller， and the server-side multi-end control method are adopted. For the problem that the unmanned ship is resistant to environmental problems， the PID algorithm is used for the heading control of the unmanned ship. The problem of poor real-time data is to use 4G network combined with data transmission module for data transmission between unmanned ship and control center. The actual experiments show that the above algorithm can realize the multi-end control， real-time data transmission and automatic cruise function of the unmanned ship.

Key Words： unmanned boat; Raspberry Pi; multi-end control; control system

基金項目：蘇州市前瞻性應用研究項目（SYG201837）;南通市應用基礎研究計劃項目（GY12016015）;南通大學—南通智能信息技術聯(lián)合研究中心開放課題項目（KFKT2017A06）

作者簡介：劉瑞（1994-），男，南通大學計算機科學與技術學院碩士研究生，研究方向為計算機應用;丁浩（1980-），男，碩士，南通大學計算機科學與技術學院講師，研究方向為計算機應用技術。

0 引言

無人艇的發(fā)展起源于第二次世界大戰(zhàn)，最初被作為一次性制導武器應用于戰(zhàn)場，之后開始逐漸應用于各個領域[1]。無人船相比于傳統(tǒng)由船員控制的船只，具有航程長、載重多、維護費用低，且更適合行駛于危險復雜水域的優(yōu)勢，因此有著廣闊的應用前景[2-4]。

目前無人船技術尚未完全成熟，尤其是單無人船控制系統(tǒng)設計及多無人船自動化系統(tǒng)設計一直是一個難點和挑戰(zhàn)[1]。針對無人船的控制系統(tǒng)問題，國內外研究者開展了各種研究[5-8]。美國圣克拉拉大學（SCU）和蒙特利灣水族館研究所（MBARI）在2009年研制出SeaWASP用于環(huán)境監(jiān)測[9]。該船配備12V與24V電源總線，由6個12V密封鉛酸電池供電;2015年7月，云洲智能自主研發(fā)了“方洲號”全自動測繪測量無人船[10]，該無人船能夠搭載單波束、多波束、ADCP等多種測繪測量設備，并能自動化地精確開展河流流速及流量測量、水文測繪、水庫庫容勘測、水深測量等多種任務;2018年1月，廣東華中科技大學工業(yè)技術研究院研發(fā)了HUSTER-12S無人艇，該無人艇配置了差分GPS、慣導、水質監(jiān)測儀、攝像頭等傳感器，可完成水質監(jiān)測、巡邏、多無人船協(xié)同巡邏等任務。然而，上述無人船均存在造價昂貴的問題。

本文實現(xiàn)了一種基于樹莓派的小型水質監(jiān)測無人船控制系統(tǒng)，可以實現(xiàn)復雜環(huán)境下的自主巡航與避障，還可以進行船體的多端實時控制，以及船體狀態(tài)、監(jiān)測數(shù)據(jù)的實時傳輸?shù)裙δ堋?/p>

1 無人船控制系統(tǒng)設計

本文設計的小型無人船長1.2m，寬0.5m，并配備了水循環(huán)冷卻系統(tǒng)。電池采用太陽能電池，續(xù)航可達5h以上，速度可達15km/h。

1.1 控制系統(tǒng)硬件設計

控制系統(tǒng)采用太陽能電池作為供電電源，以樹莓派控制器為核心，通過串口與數(shù)據(jù)傳輸單元、慣性測量單元連接。電機通過控制螺旋槳旋轉，控制無人船行進;舵機控制螺旋槳轉向以控制無人船航向;電調根據(jù)輸入的PWM信號控制電機方向和速度;樹莓派開發(fā)板是整個系統(tǒng)的核心，可對傳感器進行控制;DTU為數(shù)據(jù)傳輸單元（Data Transfer Unit，DTU），用于無人船與數(shù)據(jù)中心的通信;IMU為慣性測量單元（Inertial Measurement Units，IMU），用于獲取無人船航向及位置信息;激光雷達用于探測周圍障礙物信息;12V電源用于為無人船的動力系統(tǒng)（電調、電機和舵機）供電;12V轉5V變壓器用于將12V電源轉換為5V，為樹莓派、DTU、IMU及激光雷達供電。無人船硬件組成及連線如圖1所示。

圖1 無人船硬件組成及連線

1.2 控制系統(tǒng)軟件設計

系統(tǒng)軟件部分分為樹莓派、Web API、桌面程序與Android程序。樹莓派接收服務器端命令與傳感器數(shù)據(jù)對船體進行控制;桌面程序和Android程序通過Web API對無人船進行遠程控制;Web API接收控制請求并發(fā)送至樹莓派，同時監(jiān)聽并處理樹莓派傳回的數(shù)據(jù)。4個模塊之間的信息流動如圖2所示。

2 硬件控制

2.1 PWM波

PWM（Paulse-Width Modulation）是一種將信息編碼為脈沖信號的調制方法，目前PWM主要用于控制電器設備的功率輸出，尤其是慣性荷載，如電動機等[11]。PWM波有兩個重要屬性：頻率與占空比。頻率是指PWM波在1s內重復的次數(shù)，單位為Hz;占空比是指在每個周期內，高電平時間占周期時間的百分比。目前業(yè)內慣用的電機控制方式為PWM方式，頻率一般是固定的，輸入占空比越大，電機轉速越快。PWM波既可以采用硬件進行實現(xiàn)，也可以用軟件模擬輸出[12-13]。

對電機與舵機的控制都是以頻率為64Hz、占空比為9.5%的PWM信號為中心。對于舵機而言，占空比在9.5%-12.8%之間時向左轉，占空比在6.25%-9.5%之間時向右轉，且占空比偏離9.5%越多，則轉的越多;對于電機而言，占空比在9.5%-12.8%之間時反轉，占空比在6.25%-9.5%之間時正轉，占空比偏離9.5%越多，則轉的越快。

本文使用軟件模擬方式輸出指定頻率與占空比的PMW波。模擬的基本思路是首先分別計算單位周期內輸出高電平與輸出低電平的時間，然后按照高低電平時間不斷將其循環(huán)輸出即可。詳細流程如圖3所示。

圖3 模擬輸出PWM波流程

2.2 電機與舵機控制

舵機有3個引腳，分別是VCC、GND和SIG。VCC引腳連接12V電源正極，GND引腳連接電源負極，SIG引腳則連接樹莓派開發(fā)板的GPIO.0引腳。為了減少控制信號干擾，GND引腳需要連接樹莓派的GND引腳。

與控制舵機不同，樹莓派并不是直接控制電機，而是通過輸出PWM方波給電調（ESC），從而間接控制電機的轉動方向與轉動速度。電調與舵機類似，同樣有3個引腳，分別是VCC、GND和SIG。VCC引腳連接12V電源正極，GND引腳連接電源負極，SIG引腳則連接樹莓派開發(fā)板的GPIO.0引腳。同樣，為了減少干擾，GND引腳需要連接樹莓派的GND引腳。

2.3 激光雷達

自20世紀60年代左右激光出現(xiàn)后，激光雷達得到了迅速發(fā)展。時至今日，激光雷達相比于其它同類傳感器，具有經濟、可靠的優(yōu)勢[14]。本文采用的激光雷達是砝石公司FaseLase 最新研制的一款小型，且較為經濟的二維激光掃描雷達，其可以探測周邊360°范圍10m內的環(huán)境信息。

該激光雷達通信方式為UART_TTL串口，比特率為230 400bps，其二進制輸出為4字節(jié)一組，包含距離值和角度值，角度精度為1/16度。

3 數(shù)據(jù)處理與導航控制

3.1 DTU配置與使用

DTU是將串口數(shù)據(jù)轉換為IP數(shù)據(jù)或將IP數(shù)據(jù)轉換為串口數(shù)據(jù)，并通過4G通信網(wǎng)絡進行傳送的無線終端設備，可以大大增加無人船通信范圍，并在任何地方都保持與服務器的無線通信。本文采用的DTU主要有8個引腳，主要包括VCC、GND，兩個RS232串口（TX，RX）和一個485串口（A+，B）。該DTU能接受的電壓范圍為3V～12V，所以將DTU的VCC和GND引腳直接連接至12V電源的正負極，連接好DTU后插入SIM卡，最后配置DTU連接的服務器IP地址和端口號。

3.2 信息采集

IMU通過測量其三軸方向上的加速度、角速率和磁場[15]，可以獲知IMU當前的三維姿態(tài)，也可以用于追蹤3D運動[16]。本文采用集成AHRS與GPS功能的IMU采集位置信息及航向信息。IMU通過USB與樹莓派連接，通信方式為UART_TTL全雙工串口，115 200bps，8 位數(shù)據(jù)位，1 位停止位，無校驗。IMU上電啟動準備完成后，等收到START 報文才開始按固定頻率自動發(fā)送數(shù)據(jù)包，直至收到STOP報文后停止;然后根據(jù)數(shù)據(jù)包格式，不斷讀取串口;最后將接收到的數(shù)據(jù)整理成數(shù)據(jù)包并進行校驗，檢驗通過則讀取數(shù)據(jù)包，獲得傳感器返回位置與航向等信息。具體信息收集流程如圖4所示。

3.3 自動導航

航向控制是無人船自動導航中必須解決的問題之一，本文采用PID對無人船進行航向控制。PID（Proportion Integration Differentiation）控制器作為最早實用化的控制器，已有近百年歷史。其簡單易懂，使用中不需精確的系統(tǒng)模型等先決條件，因而成為應用最為廣泛的控制器之一[17-18]。

自動導航的硬件基礎是樹莓派，樹莓派是一款經濟的、支持完全自定義與編程的微型電腦[19]。在樹莓派上可以安裝Linux操作系統(tǒng)，并通過Python等程序設計語言很方便地實現(xiàn)對硬件的控制與交互[20]。在自動導航時，樹莓派通過IMU收集船體位置與航向數(shù)據(jù)，計算無人船的下一步航向角度，當船體需要左轉或右轉時，控制舵機完成相應動作。

3.4 遠程控制

自動導航是無人船的基礎功能，而在開發(fā)自動導航過程中，無人船不可避免地會出現(xiàn)各種意外情況，如失控、碰撞等。為了妥善處理這種情況，本文設計用戶可通過Android端或桌面端遠程控制無人船，且其優(yōu)先級高于自動導航，以方便用戶在自動導航出現(xiàn)異?；蛞馔鈺r迅速接管無人船的控制權。

當用戶在任意終端發(fā)出遠程控制請求時，都會向服務器端的Web API發(fā)送相應請求。Web API接收到請求后，根據(jù)相應參數(shù)向DTU寫入指令。同時在無人船上，樹莓派開發(fā)板中始終有一個進程在監(jiān)聽DTU的通信，當收到Web API發(fā)送的指令時，樹莓派將終止自動導航程序并執(zhí)行相應的遠程控制指令，從而實現(xiàn)人工遠程控制。

4 實驗結果與分析

實驗測試在南通大學的中心湖中進行，首先在水域上設定起始點與目標點區(qū)域（直徑1m的圓），無人船通過自動導航依次到達每個目標點。實驗場景如圖5所示。

圖5 實驗場景

將無人船姿態(tài)數(shù)據(jù)實時傳輸?shù)椒掌鬟M行保存，首先依次設定環(huán)形軌跡、Z字形軌跡，得到GPS軌跡如圖6、圖7所示。

圖6 自動導航環(huán)形航行

圖7 自動導航Z字型航行

其中空心圓為目標點區(qū)域，圖6中黑色點表示無人船航行位置，圖7中箭頭為無人船航行點以及航行方向。從圖中可以看出，無人船較為平穩(wěn)地航向各目標點區(qū)域，并且在航行至目標點區(qū)域后，迅速轉向下一目標點，直至到達最終目標點。實驗證明了本文系統(tǒng)的可行性及穩(wěn)定性。

5 總結與展望

本文采用樹莓派進行中樞控制，DTU進行數(shù)據(jù)傳輸，IMU進行無人船姿態(tài)獲取，并采用PID算法進行航向控制，從而實現(xiàn)了多目標點航行、多端隨時隨地控制、數(shù)據(jù)實時傳輸?shù)裙δ?，具有價格低廉、控制方便快捷等優(yōu)點。但在實際環(huán)境中，會存在如礁石、海藻等障礙物，所以接下來需要在巡航過程中加入避障功能，以實現(xiàn)真正意義上的自動巡航。

參考文獻：

[1] LIU Z， ZHANG Y， YU X， et al. Unmanned surface vehicles： an overview of developments and challenges[J]. Annual Reviews in Control， 2016， 41： 71-93.

[2] CACCIA M， BIBULI M， BONO R， et al. Unmanned surface vehicle for coastal and protected waters applications： the charlie project[J]. Marine Technology Society Journal， 2007， 41（2）：62-71.

[3] 天鷹. 從無人水面艇的軍事應用看中國海軍無人水面艇的發(fā)展前景[J]. 艦載武器， 2012（2）：28-34.

[4] 金久才， 張杰， 邵峰，等. 一種海洋環(huán)境監(jiān)測無人船系統(tǒng)及其海洋應用[J]. 海岸工程， 2015， 34（3）：87-92.

[5] MOUSAZADEH H，JAFARBIGLU H，ABDOLMALEKI H，et al. Developing a navigation， guidance and obstacle avoidance algorithm for an unmanned surface vehicle （USV） by algorithms fusion[J]. Ocean Engineering， 2018， 159：56-65.

[6] SHARMA S K，NAEEM W， SUTTON R. An autopilot based on a local control network design for an unmanned surface vehicle[J]. The Journal of Navigation， 2012， 65（2）：21.

[7] 張浩昱，劉濤. 一種微小型無人船控制系統(tǒng)設計及航向控制方法研究[J]. 計算機測量與控制， 2017， 25（1）：88-90.

[8] 謝朔，柳晨光，初秀民，等. 基于混合式體系結構的無人船控制系統(tǒng)設計[J]. 船海工程， 2016， 45（3）：39-42.

[9] BECK E，KIRKWOOD W，CARESS D，et al. SeaWASP： a small waterplane area twin hull autonomous platform for shallow water mapping[C].Autonomous Underwater Vehicles， IEEE， 2009.

[10] 付明亮.無人船在水下地形測量中的應用與探討[J].城市地理，2017 （20）：59-60.

[11] 張相軍，陳伯時. 無刷直流電機控制系統(tǒng)中PWM調制方式對換相轉矩脈動的影響[J]. 電機與控制學報， 2003， 7（2）：87-91.

[12] 馮浩明. 水面無人船航行控制器開發(fā)研究[D]. 哈爾濱： 哈爾濱工程大學，2013.

[13] 張國騫. 基于Zigbee遠程濕地監(jiān)控系統(tǒng)的無人船運動系統(tǒng)設計[D].保定：河北大學，2014.

[14] MOLEBNY V，MCMANAMON P F，STEINVALL O，et al. Laser radar： historical prospective—from the east to the west[J]. Optical Engineering， 2016， 56（3）： 031220.

[15] SEEL T， RAISCH J， SCHAUER T. IMU-based joint angle measurement for gait analysis[J]. Sensors， 2014， 14（4）： 6891-6909.

[16] HESCH J A，KOTTAS D G，BOWMAN S L，et al. Camera- IMU-based localization： observability analysis and consistency improvement[J]. The International Journal of Robotics Research， 2014， 33（1）： 182-201.

[17] TANG K S，MAN K F，CHEN G，et al. An optimal fuzzy PID controller[J]. IEEE Transactions on Industrial Electronics， 2001， 48（4）：757-765.

[18] 喬大雷， 侯嬌， 薛鋒. 基于物聯(lián)網(wǎng)技術的無人船智能航行控制系統(tǒng)設計與實現(xiàn)[J]. 艦船科學技術， 2017（23）：149-152.

[19] VUJOVI？ V， MAKSIMOVI？ M. Raspberry Pi as a sensor web node for home automation[J]. Computers & Electrical Engineering， 2015，44：153-171.

[20] 馮曉晨，張鐵成，段家興. 基于樹莓派開發(fā)板的F1吉祥物機器人設計[J]. 科技創(chuàng)新與應用， 2017（30）：32.

（責任編輯：黃 ?。?/p>