曲向宇 ，李一平

（1. 中國(guó)科學(xué)院沈陽自動(dòng)化研究所 機(jī)器人學(xué)國(guó)家重點(diǎn)實(shí)驗(yàn)室，遼寧 沈陽 110016；2. 中國(guó)科學(xué)院機(jī)器人與智能制造創(chuàng)新研究院，遼寧 沈陽 110169；3. 中國(guó)科學(xué)院大學(xué)，北京 100049）

海洋鋒面是指海洋中存在兩種或多種理化性質(zhì)顯著不同的水體的區(qū)域，該區(qū)域水文要素呈現(xiàn)較高的水平梯度，在空間上呈狹長(zhǎng)帶狀結(jié)構(gòu)[1]。因?yàn)殇h面區(qū)域內(nèi)的能量交換非常強(qiáng)烈，所以海洋鋒面在海洋動(dòng)力學(xué)的研究中十分重要。同時(shí)，由于鋒區(qū)內(nèi)存在特殊的物理過程，特別是上升流現(xiàn)象，使得該區(qū)域海水富營(yíng)養(yǎng)化，海水初級(jí)生產(chǎn)力提高，與海洋產(chǎn)業(yè)活動(dòng)聯(lián)系十分緊密。另外，海洋鋒面對(duì)水聲通信技術(shù)的影響也非常明顯。因此，研究和觀測(cè)海洋鋒面這種海洋現(xiàn)象，對(duì)于海洋科學(xué)、海洋漁業(yè)以及海洋軍事作戰(zhàn)具有重大意義[2]。

常規(guī)的海洋特征觀測(cè)方法如潛標(biāo)、浮標(biāo)，使用相應(yīng)的傳感器，在固定的位置或在漂流狀態(tài)下進(jìn)行觀測(cè)。而自主水下機(jī)器人（AUV）利用自身搭載的傳感器，可以實(shí)現(xiàn)對(duì)目標(biāo)區(qū)域水文要素的連續(xù)動(dòng)態(tài)觀測(cè)，相較于常規(guī)方法具有快速性和自主性的優(yōu)點(diǎn)[3]。由于鋒面這種海洋特征，易受風(fēng)、海流等因素影響，水文要素復(fù)雜且變化較快，為了快速對(duì)指定區(qū)域采樣，通常使用AUV 進(jìn)行海洋特征的觀測(cè)[4]。

AUV 通常采用梳狀觀測(cè)方法，對(duì)感興趣區(qū)域進(jìn)行覆蓋觀測(cè)，但該方法缺乏自主性和靈活性，不適合作為海洋特征觀測(cè)的方法[5-6]。Zhang Y 等[7-8]提出了一種基于溫度梯度閾值的“之”字鋒面跟蹤算法，該方法設(shè)置了鋒面的溫度梯度閾值，用來判斷AUV是否進(jìn)入鋒面，并通過對(duì)航向角的調(diào)整，實(shí)現(xiàn)AUV在觀測(cè)區(qū)域內(nèi)的往復(fù)鋒面跟蹤。Wang D[9]根據(jù)實(shí)時(shí)觀測(cè)到的溫度數(shù)據(jù)，利用最小二乘法估計(jì)鋒面區(qū)域的梯度方向，保持AUV 沿著溫度梯度上升或下降的方向前進(jìn)，當(dāng)?shù)竭_(dá)設(shè)定的等溫線進(jìn)行折返，實(shí)現(xiàn)AUV 在指定溫度邊界之間的鋒面跟蹤?？紤]到鋒區(qū)的形態(tài)往往較為復(fù)雜，需要鋒面跟蹤算法具有較高的環(huán)境適應(yīng)性，避免陷入特定區(qū)域重復(fù)觀測(cè)?；谝陨峡紤]，本文提出了一種基于溫度動(dòng)態(tài)估計(jì)的鋒面跟蹤算法，在AUV 到達(dá)鋒面邊界時(shí)，通過沿等溫線跟蹤一段距離，來加快鋒面跟蹤速度，并脫離“陷阱”區(qū)域，保持了對(duì)鋒面的持續(xù)跟蹤能力；選用高斯過程回歸（GPR），替代最小二乘法作為溫度動(dòng)態(tài)估計(jì)的方法，增加了近鄰區(qū)溫度預(yù)測(cè)的準(zhǔn)確性[10-12]。

1 鋒面區(qū)域模擬

1.1 研究區(qū)域

中國(guó)的東部近海在冬季有著穩(wěn)定豐富的海洋鋒面現(xiàn)象。本文選取一個(gè)典型的沿岸鋒面——山東半島南部“N”形鋒面作為研究對(duì)象。該鋒面在冬季位置穩(wěn)定，具有規(guī)則的形態(tài)，在121°E 西面平行于海岸線，在 121°E，36°N（A 區(qū)域）以東呈離岸走勢(shì)，向東南方向約伸展到 122°E，35.5°N 附近，在該位置東面，沿東北方向分布至山東外海。該鋒面呈現(xiàn)了一個(gè)完整的“N”形結(jié)構(gòu)，在12 月中旬至2 月中旬之間，鋒面豐富且形態(tài)成熟，3 月份之后逐漸消亡[13]?？紤]到AUV 的續(xù)航力有限，無法對(duì)整個(gè)鋒面全部觀測(cè)，故本文選取“N”形鋒面的A 區(qū)域，用于鋒面跟蹤算法的仿真驗(yàn)證。

1.2 溫度數(shù)據(jù)獲取與處理

本文選用MODIS 海溫衛(wèi)星遙感資料作為鋒區(qū)溫度數(shù)據(jù)來源，MODIS 的L3 級(jí)數(shù)據(jù)產(chǎn)品可提供全球范圍的遙感數(shù)據(jù)。文中所需的海水表層溫度（SST）數(shù)據(jù)由美國(guó)國(guó)家航空航天局（NASA）網(wǎng)站免費(fèi)提供，下載的數(shù)據(jù)集名稱為AQUA_MODIS.20191211.L3m.DAY.SST.sst.4 km.NRT.nc，空間分辨率為4.64 km，時(shí)間分辨率為1 d。通過對(duì)數(shù)據(jù)集的處理，可以繪制出“N”形鋒面的SST 圖像。如圖1 所示，給出了在2019 年12 月11 日該區(qū)域的海水溫度情況。

圖1 山東半島南部“N”形鋒面

從圖中可以明顯地觀察到“N”形鋒面的形態(tài)和位置，其中鋒面的 A 區(qū)域在 121°E、36°N 附近。進(jìn)一步縮小數(shù)據(jù)集范圍，A 區(qū)域SST 圖像如圖2 所示。

圖2 鋒面A 區(qū)域

考慮數(shù)據(jù)集中溫度值的空間分辨率為4.64 km，圖2 中所示區(qū)域內(nèi)的數(shù)據(jù)點(diǎn)過少，無法滿足在鋒面跟蹤任務(wù)中對(duì)算法對(duì)采樣數(shù)據(jù)的處理需求。因此，本文利用樣條函數(shù)插值的方法對(duì)所選區(qū)域的數(shù)據(jù)點(diǎn)進(jìn)行插值處理。定義了一個(gè)長(zhǎng)度為45 km、寬度為35 km 的任務(wù)區(qū)域，設(shè)置溫度數(shù)據(jù)點(diǎn)的間距為0.1 km，經(jīng)插值后得到的A 區(qū)域溫度場(chǎng)如圖3 所示。至此，本文完成了任務(wù)所選鋒面區(qū)域的溫度場(chǎng)模擬。

圖3 插值后的鋒面A 區(qū)域

2 鋒面跟蹤算法

考慮到海洋特征的水平與垂直性質(zhì)，AUV 通常采用水平分層觀測(cè)或者垂直剖面觀測(cè)的方法進(jìn)行特征跟蹤。由于鋒面具有較高的溫度水平梯度，一般令A(yù)UV 在固定的深度執(zhí)行鋒面觀測(cè)任務(wù)。本文利用AUV 近一段時(shí)間內(nèi)采集的溫度數(shù)據(jù)，通過高斯過程回歸的方法預(yù)測(cè)近鄰區(qū)溫度分布，并根據(jù)預(yù)測(cè)結(jié)果，選取AUV 下一次鋒面跟蹤的路徑點(diǎn)。在路徑規(guī)劃階段，首先判斷AUV 所處鋒區(qū)位置，若在鋒區(qū)內(nèi)部，則保持跟蹤路徑沿著溫度梯度方向，在鋒區(qū)內(nèi)執(zhí)行梯度下降或上升的鋒面跟蹤動(dòng)作；當(dāng)航行到鋒面邊界時(shí)，采取沿等溫線跟蹤的動(dòng)作。本文提出的鋒面跟蹤算法流程圖如圖4 所示。

2.1 預(yù)規(guī)劃

本文令A(yù)UV 在觀測(cè)區(qū)內(nèi)的等溫線Thot和Tcold之間（冷熱水團(tuán)分界面），進(jìn)行鋒面跟蹤任務(wù)。當(dāng)開始執(zhí)行任務(wù)時(shí)，假定AUV 的任務(wù)初始點(diǎn)在任務(wù)區(qū)域外，令其沿著預(yù)定義航向運(yùn)動(dòng)到等溫線Thot或Tcold上，之后開始執(zhí)行鋒面跟蹤算法。這樣做有兩個(gè)好處，一是AUV 的布放位置可以有更多的選擇，二是為溫度預(yù)測(cè)累計(jì)輸入樣本。

圖4 本文鋒面跟蹤算法流程圖

2.2 近鄰區(qū)溫度預(yù)測(cè)

高斯過程回歸（GPR）是一種優(yōu)秀的環(huán)境模型估計(jì)方法，本文利用GPR 方法對(duì)AUV 一段時(shí)間內(nèi)采樣的溫度數(shù)據(jù)進(jìn)行分析，來預(yù)測(cè)當(dāng)前位置附近區(qū)域的溫度場(chǎng)分布。已知AUV 在鋒區(qū)近一段時(shí)間內(nèi)n次溫度采樣的數(shù)據(jù)，其中輸入位置集合X={xi∈Rd|i=1，2，…，n}，對(duì)應(yīng)有溫度集合 y={yi|i=1，2，…，n}，共同構(gòu)成訓(xùn)練數(shù)據(jù)集D={X,y}。利用GPR 方法，可對(duì)D 找到反映出訓(xùn)練集合內(nèi)輸入與輸出之間的函數(shù)映射關(guān)系，并根據(jù)測(cè)試位置X*，求出對(duì)應(yīng)的預(yù)測(cè)值y*，獲得了指定位置的溫度預(yù)測(cè)值。

在任務(wù)區(qū)域內(nèi)，AUV 保持固定航速，Δt 為相鄰采樣時(shí)間間隔，相鄰采樣點(diǎn)之間的距離為R0。隨著任務(wù)執(zhí)行時(shí)間的不斷增加，AUV 溫度采樣的數(shù)據(jù)越來越多。若將所有的數(shù)據(jù)都作為GPR 的樣本輸入，無疑會(huì)增加溫度預(yù)測(cè)的數(shù)據(jù)處理時(shí)間，并且較早的歷史數(shù)據(jù)會(huì)干擾當(dāng)前位置的預(yù)測(cè)結(jié)果。本文通過設(shè)定預(yù)測(cè)窗口寬度m，來定期更新GPR 的樣本輸入數(shù)據(jù)集合。如果采樣點(diǎn)無法填滿窗口，將寬度m 臨時(shí)調(diào)整為此時(shí)的采樣點(diǎn)數(shù)量。

2.3 自適應(yīng)路徑規(guī)劃

AUV 的自適應(yīng)路徑規(guī)劃主要被分為兩種情況，沿梯度方向跟蹤和沿等溫線跟蹤。通過判斷AUV當(dāng)前位置，決定其下一步規(guī)劃執(zhí)行的具體任務(wù)。如圖5 所示，為自適應(yīng)路徑規(guī)劃的示意圖。

2.3.1 位置判斷方法 本文將溫度閾值作為對(duì)AUV 位置進(jìn)行判斷的條件，表示為：

圖5 自適應(yīng)路徑規(guī)劃示意圖

式中：Tk表示當(dāng)前位置的溫度值；Tb為上一次所達(dá)邊界的溫度值；閾值當(dāng)滿足ΔT≥Tth時(shí)，判斷當(dāng)前位置位于等溫線邊界，開始執(zhí)行沿等溫線跟蹤任務(wù)，并且令Tb=Tk，更新邊界溫度；若不滿足，判斷位于鋒區(qū)，繼續(xù)執(zhí)行沿梯度方向跟蹤任務(wù)。

2.3.2 沿梯度方向跟蹤 鋒區(qū)具有較高的溫度水平梯度，本文定義從溫度邊界Thot向Tcold運(yùn)動(dòng)時(shí)，執(zhí)行梯度下降搜索策略，反之執(zhí)行梯度上升搜索策略。海洋鋒面是動(dòng)態(tài)變化的，為了提高觀測(cè)速度，結(jié)合實(shí)時(shí)預(yù)測(cè)的溫度場(chǎng)可以確定鋒區(qū)內(nèi)AUV 相鄰觀測(cè)點(diǎn)之間的最優(yōu)距離R?？紤]預(yù)測(cè)溫度場(chǎng)的準(zhǔn)確性隨距離成負(fù)相關(guān)，觀測(cè)點(diǎn)之間的距離不宜過大，定義Ri∈[R0hR0]，其中h 為常數(shù)。若AUV 當(dāng)前位置為xk，溫度值為yk，利用GPR 對(duì)與當(dāng)前位置距離為Ri的圓形觀測(cè)區(qū)域的溫度場(chǎng)進(jìn)行估計(jì)，可以獲得溫度預(yù)測(cè)集合YRi，對(duì)應(yīng)位置坐標(biāo)集合PRi。若為梯度上升方向，對(duì)應(yīng)Ri的估計(jì)梯度值GRi表示為：

若為梯度下降方向，GRi表示為：

式中：αRi為距離權(quán)重因子，衡量預(yù)測(cè)半徑對(duì)估計(jì)值的影響，表示為：

i最優(yōu)觀測(cè)距離R=Ri，表示對(duì)應(yīng)期望觀測(cè)點(diǎn)的鋒面強(qiáng)度最高。接下來求取期望觀測(cè)點(diǎn)的坐標(biāo)，考慮對(duì)應(yīng)R的坐標(biāo)集合溫度預(yù)測(cè)值集合Y=R若為梯度上升搜索，則YR；若為梯度下降搜索，則將對(duì)應(yīng)的作為 AUV 的第 k+1 次觀測(cè)位置 xk+1。考慮AUV 的采樣間隔為R0，則觀測(cè)目標(biāo)之間的采樣路徑點(diǎn)數(shù)記為R/R0，分布在相鄰觀測(cè)點(diǎn)所在位置之間的直線上，沿梯度方向路徑點(diǎn)選取如圖6 所示。

圖6 沿梯度方向路徑點(diǎn)選取

2.3.3 沿等溫線跟蹤 當(dāng)AUV 沿著梯度方向運(yùn)動(dòng)到溫度邊界時(shí)，根據(jù)鋒面跟蹤算法，將路徑規(guī)劃策略切換為沿等溫線跟蹤。該部分將觀測(cè)距離固定為R0，便于控制跟蹤路徑長(zhǎng)度。本文定義跟蹤等溫線的路徑點(diǎn)數(shù)量為w，那么一次等溫線跟蹤的路徑長(zhǎng)度為w·R0。沿等溫線方向路徑點(diǎn)選取的示意圖，如圖7 所示。

圖7 沿等溫線方向路徑點(diǎn)選取

當(dāng)AUV 第k 次觀測(cè)到達(dá)溫度邊界Thot時(shí)，將采取沿等溫線跟蹤的動(dòng)作。近鄰區(qū)位置坐標(biāo)集合調(diào)整為 PB_circle，溫度預(yù)測(cè)值集合為 YB_circle，令選擇預(yù)測(cè)值最接近Thot的位置作為新的觀測(cè)點(diǎn)。半圓B 的方向角度為ψB，它決定了半圓內(nèi)的可選觀測(cè)點(diǎn)范圍，即PB_circle。ψB的值為上次跟蹤等溫線的方向，即上次等溫線跟蹤路徑上末點(diǎn)與始點(diǎn)之間的方向角，用來預(yù)測(cè)當(dāng)前跟蹤的等溫線角度。每次AUV 切換到沿等溫線跟蹤的動(dòng)作時(shí)，ψB都會(huì)被重新計(jì)算。當(dāng)AUV 沿著等溫線跟蹤的累計(jì)距離為w·R0時(shí)，將重新切換為沿梯度方向跟蹤。

3 仿真實(shí)驗(yàn)

3.1 鋒面跟蹤算法驗(yàn)證

已知觀測(cè)區(qū)域A 尺寸為35 km × 45 km，設(shè)置AUV 的采樣間隔R0=0.1 km，固定航速V=1.5 m/s，定義Thot=13℃，Tcold=12.4℃，路徑點(diǎn)總數(shù)為Num=1 500（150 km），起始位置為（8，10）。在選取不同等溫線跟蹤長(zhǎng)度w 的情況下，文中提出算法的仿真結(jié)果如8 所示。

圖8 不同w 下本文算法仿真結(jié)果

從仿真結(jié)果可以發(fā)現(xiàn)，當(dāng)w=20 時(shí)，AUV 在鋒帶彎折區(qū)域內(nèi)觀測(cè)較為密集，速度較慢，耗費(fèi)了較多的時(shí)間；當(dāng)w=25、w=30 時(shí)，算法均迅速地?cái)[脫了彎折區(qū)域，較快地完成了鋒面跟蹤任務(wù)；當(dāng)w=35 時(shí)，AUV 在路徑點(diǎn)Num=1 201 時(shí)就完成了該區(qū)域的跟蹤任務(wù)，但是過快的跟蹤速度導(dǎo)致了鋒面觀測(cè)效率變低。

基于以上分析，本文算法通過改變w 的大小，可以調(diào)整AUV 在鋒面跟蹤過程中的精細(xì)觀測(cè)程度。w 應(yīng)根據(jù)具體任務(wù)選取一個(gè)合適的值，若要加快跟蹤速度、覆蓋更廣的鋒面區(qū)域，則適當(dāng)提高w 的值；若要提高對(duì)當(dāng)前區(qū)域的鋒面跟蹤精細(xì)程度，應(yīng)適當(dāng)減小w 的值。

3.2 環(huán)境實(shí)時(shí)預(yù)測(cè)效果分析

為了驗(yàn)證GPR 環(huán)境模型估計(jì)方法的準(zhǔn)確性，本文利用不同時(shí)刻預(yù)測(cè)的近鄰區(qū)溫度場(chǎng)和對(duì)應(yīng)的實(shí)際溫度場(chǎng)的均方誤差進(jìn)行描述。均方誤差的表達(dá)式為：

式中，yi表示預(yù)測(cè)值，tpi表示真實(shí)值。選取算法（w=25）執(zhí)行期間的4 個(gè)不同時(shí)刻，GPR 不同預(yù)測(cè)半徑R 對(duì)應(yīng)的均方誤差如圖9 所示。

圖中不同的Num 值描述了AUV 任務(wù)期間的不同時(shí)刻所處的位置。由上圖可知，GPR 的預(yù)測(cè)半徑R 越小，對(duì)環(huán)境的預(yù)測(cè)誤差值越低；任務(wù)執(zhí)行的越久，GPR 對(duì)環(huán)境估計(jì)的越準(zhǔn)確。算法中的預(yù)測(cè)半徑R 一般不超過0.5 km，此時(shí)預(yù)測(cè)誤差量級(jí)約為10-4，可以較為準(zhǔn)確地估計(jì)當(dāng)前AUV 近鄰區(qū)的溫度場(chǎng)，表現(xiàn)了GPR 對(duì)鋒面觀測(cè)區(qū)域優(yōu)秀的溫度估計(jì)能力。

圖9 GPR 環(huán)境實(shí)時(shí)預(yù)測(cè)的均方誤差

3.3 性能分析

為了分析算法性能，將傳統(tǒng)的鋒面之字跟蹤算法（簡(jiǎn)稱為對(duì)比方法1）和基于最小二乘法的鋒面之字跟蹤算法（簡(jiǎn)稱為對(duì)比方法2），與本文算法（w=25）進(jìn)行對(duì)比仿真實(shí)驗(yàn)。本次仿真不對(duì)路徑點(diǎn)數(shù)目進(jìn)行限制，直至完成觀測(cè)區(qū)域內(nèi)的鋒面跟蹤任務(wù)。其余仿真參數(shù)不變，各算法的仿真結(jié)果如圖10 所示。

圖10 對(duì)比仿真結(jié)果1

由上圖仿真結(jié)果可知，對(duì)比算法1 在鋒面彎折區(qū)域失去了對(duì)鋒面的跟蹤能力，無法完成對(duì)鋒面的跟蹤；對(duì)比算法2 和本文算法均可在上述仿真情況下完成鋒面跟蹤任務(wù)。

為了比較算法的觀測(cè)效率，定義了平均路徑鋒面溫度梯度值GM，代表了單位觀測(cè)路徑長(zhǎng)度上鋒面所占的比重，表示為：

式中：Gi為對(duì)應(yīng)觀測(cè)位置的溫度梯度值，采用sobel 梯度算子對(duì)插值后的溫度場(chǎng)進(jìn)行計(jì)算而得到。算法的快速性可通過任務(wù)總時(shí)間TA 來表示：

在上述仿真結(jié)果下，對(duì)比算法2 和本文算法的性能指標(biāo)如表1 所示。

表1 性能指標(biāo)

本文算法在觀測(cè)效率上與對(duì)比算法2 相近，在跟蹤速度上快了約39.4%，體現(xiàn)了本文算法鋒面跟蹤的快速性。

接下來重點(diǎn)考慮算法的穩(wěn)定性和環(huán)境適應(yīng)能力。設(shè)置Thot=13.2℃，Tcold=12.3℃，擴(kuò)大了待觀測(cè)的鋒面區(qū)域，并將起始位置調(diào)整為（5，10），保持其他參數(shù)不變，對(duì)比算法2 和本文算法的仿真結(jié)果如圖11所示。

圖11 對(duì)比仿真結(jié)果2

對(duì)比算法2 執(zhí)行任務(wù)的過程中于3 處區(qū)域陷入了重復(fù)觀測(cè)，整個(gè)任務(wù)耗費(fèi)了大量時(shí)間?？梢园l(fā)現(xiàn)，當(dāng)鋒面的形態(tài)變化較為顯著時(shí)，鋒面跟蹤任務(wù)要求算法具有一定的抗干擾能力。本文算法通過沿等溫線（即鋒區(qū)邊界）跟蹤，不斷擺脫“陷阱”，即便邊界形態(tài)變化較大，算法也能持續(xù)地跟蹤鋒面，并且保持了快速的跟蹤速度?？梢姳疚奶岢龅匿h面跟蹤算法，具有良好的環(huán)境適應(yīng)能力，且能夠穩(wěn)定、快速地跟蹤鋒面。

4 結(jié)論

本文提出了一種基于溫度動(dòng)態(tài)估計(jì)的AUV 鋒面跟蹤算法，該算法利用更新的環(huán)境信息實(shí)時(shí)預(yù)測(cè)近鄰區(qū)溫度分布，并根據(jù)當(dāng)前位置選擇不同的路徑規(guī)劃策略。若在鋒區(qū)內(nèi)部，則沿梯度方向跟蹤來搜索鋒面，通過實(shí)時(shí)預(yù)測(cè)的環(huán)境確定最優(yōu)觀測(cè)距離，從而提高鋒面觀測(cè)速度；若在鋒區(qū)邊界，則沿等溫線跟蹤來加速擺脫鋒面，通過改變邊界跟蹤長(zhǎng)度，可以實(shí)現(xiàn)對(duì)鋒面不同程度的精細(xì)觀測(cè)。使用該算法對(duì)不同觀測(cè)區(qū)域的鋒面進(jìn)行仿真，結(jié)果顯示，本文算法較于常規(guī)算法，在觀測(cè)速度和環(huán)境適應(yīng)能力上有更好的表現(xiàn)，可應(yīng)用于不同鋒面區(qū)域的跟蹤任務(wù)。本文研究中的鋒面觀測(cè)區(qū)域是水平方向的，下一步計(jì)劃是結(jié)合鋒面在垂直方向上的特性，進(jìn)行空間上的AUV 鋒面跟蹤算法研究。