[發明專利]水下自主航行器AUV自主定位方法

無效

• 申請號: 201210361203.4
• 申請日: 2012-09-25
• 公開（公告）號: CN102914786A
• 公開（公告）日: 2013-02-06
• 發明（設計）人: 張全新;仲彥;王文明;孫智;李元章;馬忠梅
• 申請（專利權）人: 北京理工大學
• 主分類號: G01S19/48
• 分類號: G01S19/48;G01S19/40
• 代理公司: 暫無信息
• 代理人: 暫無信息

技術領域

本發明涉及一種水下自主航行器(AUV)定位方法，屬于水下無線網絡領域。該發明同樣適用于水下無線傳感器節點。

背景技術

電磁波信號無法穿透水體，因此類似GPS等定位信號無法為AUV提供定位信息。同時目前AUV主要是單個應用或者有限個應用，協同定位方面并不是其研究重點。其主要定位技術是采用類似于“遙控”的遠程聲波定位控制技術，例如LBL(long?baseline)、SBL(short?baseline)和USBL(ultra?short?baseline)等聲控定位技術。此外還出現了借鑒GPS定位技術的水面浮標(buoy)和水底錨標(anchor)定位技術。但這些技術在某些特定的應用場合都存在不足。例如，聲控方法有距離限制，并且當聲控設備和AUV之間存在遮擋物時會無法傳遞聲學信號。而浮標和錨標方法必須事先在規劃工作區域鋪設定位標識點，當其長期存在時，容易暴露目標，不利于隱藏，并且其補充能量也是個很大的挑戰。而在AUV的某些應用中，其工作區域無法提前獲知，更無法事先布設定位參照點。

發明內容

本發明的目的是：無需采用傳統的水面或者水底定位錨標，讓高定位精確度的信息盡量擴散，協助低定位精確度的節點提高定位精度。只要AUV的定位精確度滿足設定要求，則該AUV就可以一直滯留水下進行工作，從而延長在水中滯留工作的時間。

AUV是在水下工作，不同于陸上系統，陸上節點的速度和航向基本不受風力等外力干擾或者干擾甚微，可以忽略不計，水中航行的AUV受水流影響非常大。這會進一步加劇儀器產生誤差的概率或者范圍。有時即使AUV本身保持靜止，水流也會慢慢將其推離原有位置。因此，完全依靠AUV自身攜帶的導航儀器在水下航行會慢慢失去精確定位，從而失去應用價值。但水流也不是完全沒有規律的，在一定程度上具有連貫性，即是漸變的。所以在某種程度上我們可以依據前一段航行過程中水流對AUV定位精度的影響程度推斷下一個階段的影響程度。

每個AUV在水下航行期間，由于無法預知追蹤儀器和水流對誤差造成的實時影響，所以我們無法預知AUV在水下航行時追蹤坐標的準確性，但實用中又需要了解在儀器和水流共同影響下的坐標準確性量化指標。為此，我們把坐標精確度依據精確度指標進行標注，稱之為λ。剛剛獲取GPS信號的AUV，具有最高定位精度，而在水下航行的AUV，由于其只能依靠所攜帶的儀器導航，并且由于累積誤差和水流等因素的干擾，其精度會慢慢降低，這個降低的過程受儀器誤差和水流的雙重影響。設計λ=(1-tn-tluN*tui)*(1-d(u,t)d(u,lu)+d(u,t))]]>來體現這兩者對精度的影響。其中t_n是當前時間，t_lu是此AUV上次坐標更新的時間，N是正整數，t_ut是AUV坐標更新的時間間隔，d_(u，t)是AUV進行坐標更新時，更正后的坐標與儀器追蹤所得坐標之間的距離差，初始值為0，d_(u，lu)是最新的兩次坐標更新之間航行過的距離，這個值可以通過最近的兩次更新時的坐標計算得出。為了防止出現除以0的情況，規定當d_(u，t)＝0時d_(u，lu)＝1(當AUV剛入水、或者AUV在某個位置保持不動時會出現d_(u，t)＝0的情況)，當d_(u，t)≠0時d_(u，lu)取實測值。定位精度λ的第一括號內部分是迫使AUV的定位精度隨著其在水下航行時間的延長而下降，代表依靠儀器導航的定位精度會越來越低。第二括號內部分是考慮儀器誤差和水流導致的誤差對精度的綜合影響(因為在AUV航行過程中產生的誤差，很難判斷出是儀器造成的還是水流造成的，所以把兩種誤差影響放在一起綜合考慮)。綜合誤差相對于航行距離的比值越大，則迫使定位精度λ下降越快。由于第二部分取決于綜合誤差和之前航行距離的比值，屬于后驗值，因此其實質是依靠之前已知的綜合誤差影響推斷當前的綜合誤差范圍，這也是基于水流變化的漸變性。由于各AUV所攜帶儀器的精度不同、航行所在的水流不同、受水流影響造成的綜合誤差不同，因此一群協同工作的AUV其定位精度λ會各不相同。如果把定位精度看成溫度的話，則定位精度越高的AUV其“溫度”越高，那么我們的目標就是讓高溫的節點對低溫的節點進行加熱，只要某個節點能從周圍的鄰居那里獲得足夠的“熱量”，能維持在設定“溫度”以上，那么該節點就不用上浮到水面上通過GPS“加到最熱”。