基于遍歷算法的智能湖泊環(huán)境監測及凈化裝置*

基金項目：遼寧省大學(xué)生創(chuàng )新創(chuàng )業(yè)訓練計劃項目

湖泊作為陸地水圈的組成部分，參與自然界的水分循環(huán)^[1]。湖泊具有凈化水質(zhì)，減少環(huán)境污染的作用。無(wú)人船(USV) 是一種可以無(wú)需遙控，借助精確衛星定位和自身傳感即可按照預設任務(wù)在水面航行的全自動(dòng)水面機器人。經(jīng)過(guò)一番改造便可以實(shí)現水上垃圾回收，目前市面上的產(chǎn)品大多數應用在寬闊的水域，如海洋，河流等。其收集方式為完全隨機，只具備一定的垃圾收集功能，超出視野之外的便無(wú)法進(jìn)行收集，面臨著(zhù)遍歷程度不高，算法不完善等問(wèn)題。由于湖泊與海洋的應用場(chǎng)景不同，湖泊大多數為靜態(tài)水，而海洋則為動(dòng)態(tài)。所以一款針對于湖泊水上垃圾清理和水質(zhì)檢測的裝置有較為廣闊的發(fā)展前景。

1 設計思路與方案

1.1 裝置結構與組成

該裝置名為智能湖泊環(huán)境監測及凈化裝置，機械結構本質(zhì)上為兩個(gè)船體，1 個(gè)垃圾籃，二維云臺，2 個(gè)驅動(dòng)船體的螺旋槳和防水草裝置，3 個(gè)投放治理水質(zhì)藥物的裝置，如圖1。

圖1 機械結構圖

1.2 基本功能

1）湖泊完全遍歷收集漂浮垃圾

將該裝置放入湖泊中，可以先調節垃圾籃的高度，方便后續垃圾收集。首先通過(guò)超聲波模塊監測船到岸邊的距離，逆時(shí)針圍繞湖邊1 圈，同時(shí)間隔一定的時(shí)間記錄當前GPS 坐標并記錄在經(jīng)緯度坐標系中，然后轉化為柵格地圖的坐標并連線(xiàn)，構建柵格地圖，每一個(gè)柵格中都了保存其中心點(diǎn)的坐標信息和是否存在障礙物。裝置根據柵格地圖從起點(diǎn)進(jìn)行往復式遍歷，在遍歷的過(guò)程中，采用攝像頭實(shí)時(shí)識別漂浮垃圾，進(jìn)行漂浮垃圾的收集功能。

2）監測水質(zhì)狀態(tài)并投放藥物進(jìn)行改善

在裝置遍歷的過(guò)程中，每經(jīng)過(guò)1 個(gè)柵格，進(jìn)行1 次水質(zhì)信息的采集，等完全遍歷每一個(gè)柵格之后，求出各個(gè)數值的平均值，并與初始設定的水質(zhì)正常數值進(jìn)行比對，然后投放定量的藥物，從而達到改善水質(zhì)的功能。

3）遠程監控湖泊狀態(tài)

該裝置進(jìn)行過(guò)程中，會(huì )統計收集的垃圾種類(lèi)和數量，當前水質(zhì)狀況，投放藥物情況，并將這些信息通過(guò)5G模塊發(fā)送給上位機，方便管理人員查看。

圖2 運行流程圖

2 實(shí)現方案與核心算法

2.1 柵格地圖構建

裝置圍繞湖泊1 圈之后，通過(guò)記錄的GPS 坐標構建出湖泊的二維坐標系，對其單位柵格化，連線(xiàn)并進(jìn)行直線(xiàn)邊緣化，填充邊界，得到柵格化后的圖像。對于后續的垃圾收集和水質(zhì)檢測，柵格地圖的構建將起到?jīng)Q定性的作用。

柵格大小的選取需要考慮如下問(wèn)題^[2]：

1）船體的大??；

2）攝像頭的視野范圍；

3）MCU 的運算和儲存能力。

2.2 全局路徑規劃

路徑規劃分為全局和局部路徑規劃^[3]，往復式完全遍歷便是全局路徑規劃，確定裝置在水上的可行路徑。在實(shí)際的運行過(guò)程中，運行的軌跡應當與障礙物保持一定的距離，從而確保裝置能夠正常通行而不發(fā)生碰撞，所以在MATLAB 仿真時(shí)需要膨脹邊界，目的是增加障礙物與路徑之間的距離，確保仿真與實(shí)際情況相似。圖像為某一湖泊的俯視圖，經(jīng)過(guò)二值化和柵格化的處理。如圖3，左側為處理后的地圖，右側為軌跡圖。黑色部分為陸地，灰色部分為膨脹部分，白色部分則為湖泊。在路徑規劃處理過(guò)程中，灰色與黑色都視為障礙物，白色為可通行水域，紅色為運行的軌跡，箭頭代表方向。

圖3 MATLAB仿真運行圖

往復式完全遍歷路徑的算法使用深度優(yōu)先搜索算法（DFS）來(lái)遍歷整個(gè)地圖，并返回遍歷路徑。在函數內部，首先獲取地圖的大小并初始化遍歷狀態(tài)矩陣和遍歷路徑。然后使用兩層循環(huán)遍歷整個(gè)地圖，如果當前位置可以通過(guò)而且未被遍歷，則將其標記為已遍歷并添加到遍歷路徑中，并調用DFS 函數繼續進(jìn)行深度優(yōu)先搜索。DFS 函數使用當前位置的坐標作為輸入，并搜索當前位置的相鄰位置。如果相鄰位置可以通過(guò)且未被遍歷，則將其標記為已遍歷并添加到遍歷路徑中，并繼續調用DFS 函數進(jìn)行深度優(yōu)先搜索。

本裝置利用兩個(gè)螺旋槳產(chǎn)生速度差，來(lái)達到方向偏轉的效果。由于得知了裝置的運行軌跡，通過(guò)實(shí)際的位置坐標和下一個(gè)目標的位置坐標便可以得到偏航角和距離，從而達到裝置沿著(zhù)完全遍歷的路徑行進(jìn)的目的。

2.3 水上垃圾目標檢測

目標檢測算法大致分為兩類(lèi)：“兩階段”和“一階段”方法?！皟呻A段”是指檢測和識別兩個(gè)階段。代表算法有RCNN、Fast-RCNN 等。而“一階段”是基于回歸的，直接回歸物體的類(lèi)別概率和位置坐標值[4]。代表算法有YOLO 系列和SSD 系列算法等。本裝置采用YOLOV3模型，使用K210 攝像頭。具體步驟分為兩步：

1）YOLOV3 模型訓練

由于K210 上識別照片的格式為240x240，所以需要預先對訓練的照片進(jìn)行格式轉化，之后使用VOTT 軟件進(jìn)行標注。本地訓練環(huán)境為Mx-yolov3，訓練完成后，需要將其轉換成K210 適配的Kmodel 文件。

2）部署到K210

打開(kāi)Kfl ash, 用數據線(xiàn)將電腦和K210 連接，將固件和Kmodel 文件燒錄到開(kāi)發(fā)板中，燒錄的過(guò)程中，其燒錄時(shí)地址不能一樣，Kmodel 文件使用0x300000。

下面選取某一水面測試訓練的模型，如圖4。

圖4 K210測試圖

2.4 局部路徑規劃

局部路徑規劃的目的是收集當前柵格內的垃圾。主要思路是進(jìn)入當前柵格，對垃圾進(jìn)行目標監測，并得到垃圾的位置坐標，如有多個(gè)垃圾，則需要局部路徑規劃，但考慮到攝像頭視野之內的垃圾可能在當前柵格之外，如果不中斷的話(huà)，則會(huì )導致其前往下一個(gè)柵格，進(jìn)而導致遍歷重復度高，所以需要一些中止措施。如果船體GPS 定位如果偏離柵格一定距離，或拾取垃圾數量超過(guò)五個(gè)，則中斷局部路徑規劃，去往下一個(gè)柵格繼續進(jìn)行全局路徑規劃。

本方案的局部路徑規劃采取一種叫做Multi-Direction Fast Marching（MDFM）的方法，它可以同時(shí)對多個(gè)目標點(diǎn)兩兩之間進(jìn)行路徑規劃，并結合遺傳算法規劃出遍歷所有目標點(diǎn)的最短路徑^[5]。此方法的基本思想是，將所有目標點(diǎn)作為起點(diǎn)，分別計算出到達其他目標點(diǎn)的最短距離和方向，然后將這些信息存儲在矩陣中。再使用遺傳算法對矩陣進(jìn)行優(yōu)化，找到一條能夠覆蓋所有目標點(diǎn)并且總距離最小的路徑。這種方法的優(yōu)點(diǎn)是，它可以有效地處理多個(gè)目標點(diǎn)之間的相互影響，避免了重復計算和冗余路徑，提高了路徑規劃的效率和質(zhì)量。

2.5 水質(zhì)監測及治理

1）檢測部分

本裝置搭載水質(zhì)檢測模塊，能夠檢測水質(zhì)的pH 值，電導率，溫度等信息。檢測功能在全局路徑規劃時(shí)運行，每到達一個(gè)柵格就采集1 次，最終求得平均值，避免局部誤差的干擾，使得數據更可靠。

2）投放器

其內部的螺旋結構可以將顆粒物投放出來(lái)，結構簡(jiǎn)單且不易被卡住。本裝置搭載3 個(gè)投放器，方便操作者自定義藥品或魚(yú)餌。而且可以將投放情況發(fā)送到上位機，方便后期的查看管理。

3 結果測試

3.1 裝置遍歷情況測試

將裝置放于湖泊的某點(diǎn)，首先自動(dòng)確定湖泊的范圍，然后開(kāi)始遍歷湖泊，并在途中拾取垃圾。根據返回的坐標點(diǎn)，導入到MATLAB 畫(huà)出實(shí)際軌跡圖，如圖5。

圖5 實(shí)際軌跡圖

由此圖像可以看出裝置能夠正常完成全局和局部路徑規劃，并且能避開(kāi)障礙物。

3.2 水質(zhì)信息數據測試

本次測試主要采集了湖泊電導率的數值，其中部分信息通過(guò)柱狀圖展示出來(lái)，如圖6。

圖6 部分柵格電導率數據

4 結束語(yǔ)

本文介紹了一款基于遍歷算法的智能湖泊環(huán)境監測及凈化裝置，其能夠自主完成路徑規劃且完整的遍歷湖泊的每一個(gè)水域，在遍歷過(guò)程中還能夠實(shí)現自主垃圾拾取和水質(zhì)信息采集，同時(shí)將數據通過(guò)4G 通信模塊發(fā)送給上位機，方便管理人員查看和后期的進(jìn)一步改善措施。相較于傳統的遍歷無(wú)人船，提出了全局和局部遍歷的方法，其遍歷程度更高，其在封閉的水域，將有著(zhù)更好的效果。此裝置將會(huì )極大的減少人力成本，有廣闊的應用前景。

參考文獻：

[1] 汪敬忠,吳敬祿,曾海鰲,等.內蒙古主要湖泊水資源及其變化分析[J].干旱區研究,2015,32(1):7-14.

[2] 程啟忠.無(wú)人船完全遍歷路徑規劃的研究[D].重慶:重慶郵電大學(xué),2019.

[3] 李治軍,林熾杰,李峰.一種多AGV調度裝置及其全局規劃與局部規劃融合方法[P].黑龍江省:CN112987721B,2022-12-13.

[4] 朱仕寧,胡曉斌,彭太樂(lè ).基于改進(jìn)YOLOv3的道路目標檢測[J].江漢大學(xué)學(xué)報(自然科學(xué)版),2023,51(1):89-96.

[5] 于暉,王永驥.基于Fast Marching方法的多目標點(diǎn)路徑規劃的研究[J].計算技術(shù)與自動(dòng)化,2015,34(3):11-15.

（本文來(lái)源于《電子產(chǎn)品世界》雜志2023年6月期）