一種基于機器視覺的離靠泊作業(yè)參數(shù)計算裝置的制造方法
【專利摘要】本發(fā)明涉及一種基于機器視覺的離靠泊作業(yè)參數(shù)計算裝置，包括：構建單元，預先建立船體坐標系、圖像坐標系、像機坐標系和標識源坐標系；測量單元，測量船艏參考點與船艉參考點的距離，以及像機安裝位置與船艏參考點的距離；獲取單元，獲取像機對岸上標識成像時刻的像機航向角與俯仰角；計算單元，計算標識源坐標系至像機坐標系的平移向量；以及計算船體坐標系和標識源坐標系的歐拉角；以及根據(jù)上述參數(shù)計算離靠泊作業(yè)參數(shù)；判斷單元，根據(jù)離靠泊作業(yè)參數(shù)判斷是否結束離靠泊作業(yè)，直到離靠泊作業(yè)結束。本發(fā)明保證岸上標識能夠在有限的像機視場范圍內成像，放寬了對像機視場、船岸位姿關系的約束，提高離靠泊參數(shù)解算精度；計算過程簡單，運算量小。
【專利說明】
一種基于機器視覺的離靠泊作業(yè)參數(shù)計算裝置
技術領域
[0001] 本發(fā)明涉及航海導航技術領域，尤其涉及一種基于機器視覺的離靠泊作業(yè)參數(shù)計 算裝置。
【背景技術】
[0002] 隨著航運業(yè)的發(fā)展，造船技術和航海技術呈現(xiàn)跨越性的進步，船舶的大型化已經(jīng) 由一種趨勢轉變?yōu)楝F(xiàn)實。因大型船舶質量與體積大、不易操作等特點，通常需要拖輪的協(xié)助 才能完成離靠泊。入泊角度、船岸距離和船岸速度是離靠泊作業(yè)過程的重要參數(shù)，通過信息 化設備對上述參數(shù)進行實時計算，為駕引人員提供準確的輔助決策信息，是高效、安全實現(xiàn) 大型船舶離靠泊的有效途徑。近年來，用于輔助大型船舶離靠泊作業(yè)的儀器設備得到快速 發(fā)展，使駕引人員從過去純粹憑經(jīng)驗靠感覺定勢靠泊發(fā)展到利用先進設備數(shù)字定量靠泊。
[0003] 從工作原理劃分，離靠泊作業(yè)設備可分為激光離靠泊作業(yè)設備、差分衛(wèi)導離靠泊 作業(yè)設備、光學離靠泊作業(yè)設備。激光離靠泊作業(yè)設備和差分衛(wèi)導離靠泊作業(yè)設備發(fā)展較 為成熟，在港口、船舶中廣泛應用。光學離靠泊作業(yè)設備利用日盲紫外波段的特殊性，能夠 在雨、霧等能見度不佳的天氣條件下使用，在近些年逐漸發(fā)展起來。
[0004] 當前，光學離靠泊作業(yè)設備存在的主要問題包括:一是未同時考慮離靠泊作業(yè)參 數(shù)與像機航向角及俯仰角的耦合關系，當岸上標識處于相機視場邊緣時，難以通過多個維 度對相機角度進行調整，影響了岸上標識在相機視場內的成像質量，降低了離靠泊作業(yè)參 數(shù)解算精度;二是采用異面標識，離靠泊作業(yè)參數(shù)計算方法復雜，運算量較大。

【發(fā)明內容】

[0005] 鑒于上述的分析，本發(fā)明旨在提供一種基于機器視覺的離靠泊作業(yè)參數(shù)計算裝 置，用以解決現(xiàn)有離靠泊作業(yè)參數(shù)解算精度不夠以及運算復雜的問題。
[0006] 本發(fā)明的目的主要是通過以下技術方案實現(xiàn)的：
[0007] 本發(fā)明提供了一種基于機器視覺的離靠泊作業(yè)參數(shù)計算方法，包括：
[0008] 預先建立船體坐標系Ob-XbYbZb、圖像坐標系I-XY、像機坐標系Oc-X cYcZc和標識源坐 標系 Ou-XuYuZu;
[0009] 測量船艏參考點與船艉參考點的距離L，以及像機安裝位置與船艏參考點的距離 Lc;
[0010] 獲取像機對岸上標識成像時刻的像機航向角P與俯仰角δ;
[0011] 計算標識源坐標系Ou-XuYuZ u至像機坐標系0「ΧΙΖ。的平移向量[Tx Ty Τζ]τ;
[0012] 計算船體坐標系Ob-XbYbZb和標識源坐標系Ou-XuYuZ u的歐拉角(0 y爐)'：
[0013] 根據(jù)上述參數(shù)計算離靠泊作業(yè)參數(shù)，判斷是否結束離靠泊作業(yè)，如果否，重新獲取 像機對岸上標識成像時刻的像機航向角P與俯仰角δ，再次離靠泊作業(yè)參數(shù)計算，直到離靠 泊作業(yè)結束;如果是，則結束計算。
[0014] 進一步地，所述離靠泊作業(yè)參數(shù)包括：
[0015] 入泊角β、船艏與岸線距離Lb、船艉與岸線距離Ls、船艏相對于岸線的橫向速度Vb、 船艉相對于岸線的橫向速度Vs。
[0016] 進一步地，根據(jù)如下公式計算離靠泊作業(yè)參數(shù)：
[0017]
[0018]
[0019]
[0020]
[0021]
[0022] 進一步地，計算標識源坐標系Ou-XuYuZ u至像機坐標系Oc-XcYcZc的平移向量[Tx Ty 1^]7的過程具體包括：
[0023]根據(jù)圖像坐標系I-XY和像機坐標系Oc-XcYcZ c的定義，通過像機標定獲取圖像主點 (Cx，Cy )、橫向等效焦距Fx、縱向等效焦距Fy;
[0024] 計算位姿中間變量ei、e3、e4、e 6、Θ7;
[0025] 根據(jù)圖像主點（Cx，Cy)、橫向等效焦距Fx、縱向等效焦距F y以及位姿中間變量，計算 計算標識源坐標系Ou-XuYuZ u至像機坐標系Oc-XcYcZc的平移向量[Tx Ty Τζ]τ。
[0026] 進一步地，計算船體坐標系Ob-XbYbZb和標識源坐標系Ou-X uYuZu的歐拉角
的過程具體包括：
[0030] 其中，!^、^、^'、^、^通過以下公式確定：[0031][0032]
[0027]
[0028]
[0029]
[0033]
[0034]
[0035]
[0036]
[0037] 本發(fā)明還提供了一種基于機器視覺的離靠泊作業(yè)參數(shù)計算裝置，包括：
[0038]構建單元，用于預先建立船體坐標系0b-XbYbZ b、圖像坐標系Ι-ΧΥ、像機坐標系Oc-XcYcZc和標識源坐標系Ou-X uYuZu;
[0039]測量單元，用于測量船艏參考點與船艉參考點的距離L，以及像機安裝位置與船艏 參考點的距離Lc;
[0040]獲取單元，用于獲取像機對岸上標識成像時刻的像機航向角P與俯仰角δ;
[0041 ] 計算單元，用于計算標識源坐標系Ou-XuYuZ u至像機坐標系Oc-XcYcZc的平移向量[T x Ty Τζ]τ;以及計算船體坐標系Ob-XbYbZb和標識源坐標系O u-XuYuZu的歐拉：
，以及 根據(jù)上述參數(shù)計算離靠泊作業(yè)參數(shù)；
[0042] 判斷單元，用于根據(jù)離靠泊作業(yè)參數(shù)判斷是否結束離靠泊作業(yè)，如果否，重新獲取 像機對岸上標識成像時刻的像機航向角P與俯仰角δ，再次離靠泊作業(yè)參數(shù)計算，直到離靠 泊作業(yè)結束;如果是，則結束計算。
[0043] 進一步地，所述離靠泊作業(yè)參數(shù)包括：
[0044]入泊角β、船艏與岸線距離Lb、船艉與岸線距離Ls、船艏相對于岸線的橫向速度Vb、 船艉相對于岸線的橫向速度Vs。
[0045] 進一步地，所述計算單元根據(jù)如下公式計算離靠泊作業(yè)參數(shù)：
[0046]
[0047]
[0048]
[0049]
[0050]
[0051 ] 進一步地，所述計算單元計算標識源坐標系Ou-XuY uZu至像機坐標系OcHZc的平 移向量[Tx Ty Τζ]τ的過程具體包括：
[0052]根據(jù)圖像坐標系I-XY和像機坐標系Oc-XcYcZ c的定義，通過像機標定獲取圖像主點 (Cx，Cy )、橫向等效焦距Fx、縱向等效焦距Fy;
[0053] 計算位姿中間變量ei、e3、e4、e6、 e7;
[0054] 根據(jù)圖像主點（Cx，Cy)、橫向等效焦距Fx、縱向等效焦距F y以及位姿中間變量，計算 計算標識源坐標系Ou-XuYuZ u至像機坐標系Oc-XcYcZc的平移向量[Tx Ty Τζ]τ。
[0055] 進一步地，所述計算單元計算船體坐標系Ob-Xb YbZb和標識源坐標系Ou-XuYuZ u的歐
拉角P r of的過程具體包括：
[0056]
[0057]
[0058]
[0059]
[0060]
[0061]
[0062]
[0063]
[0064]
[0065]
[0066] 本發(fā)明有益效果如下：
[0067]本發(fā)明保證岸上標識能夠在有限的像機視場范圍內成像，放寬了對像機視場、船 岸位姿關系的約束，提高了離靠泊參數(shù)解算精度;計算過程簡單，運算量小。
[0068] 本發(fā)明的其他特征和優(yōu)點將在隨后的說明書中闡述，并且，部分的從說明書中變 得顯而易見，或者通過實施本發(fā)明而了解。本發(fā)明的目的和其他優(yōu)點可通過在所寫的說明 書、權利要求書、以及附圖中所特別指出的結構來實現(xiàn)和獲得。
【附圖說明】
[0069] 附圖僅用于示出具體實施例的目的，而并不認為是對本發(fā)明的限制，在整個附圖 中，相同的參考符號表不相同的部件。
[0070] 圖1為本發(fā)明實施例方法的流程示意圖；
[0071 ]圖2為本發(fā)明實施例所述方法中，離靠泊作業(yè)場景的示意圖；
[0072]圖3為本發(fā)明實施例所述裝置的結構示意圖。
【具體實施方式】
[0073]下面結合附圖來具體描述本發(fā)明的優(yōu)選實施例，其中，附圖構成本申請一部分，并 與本發(fā)明的實施例一起用于闡釋本發(fā)明的原理。
[0074]如圖1所示，圖1為本發(fā)明實施例所述基于機器視覺的離靠泊作業(yè)參數(shù)計算方法的 流程示意圖，具體可以包括下列步驟：
[0075] 步驟101:建立船體坐標系0b-XbYbZb、圖像坐標系I-XY、像機坐標系Oc-X cYcZc和標識 源坐標系Ou-XuYuZu 〇
[0076] 各坐標系的定義如下：
[0077] 船體坐標系Ob-Xb YbZb:原點Ob位于船體質心，Xb軸指向船舶的右舷，Yb軸指向船艏， Zb軸垂直于甲板平面向上，與Xb軸和Yb軸構成右手坐標系。
[0078] 圖像坐標系I-XY:原點I位于圖像的左上角點，X軸沿水平方向指向右，Y軸沿豎直 方向指向下。
[0079] 像機坐標系Oc-XcYcZc:原點Oc位于像機光心，X c軸和Yc軸分別與圖像坐標系的X軸 和Y軸平行，Z。軸沿像機光軸，與平面圖像垂直。
[0080] 標識源坐標系Ou-XuYuZu:原點O u位于泊位參考點，Xu軸垂直于碼頭前沿線，與靠泊 方向一致，Zu垂直于碼頭地面向上，Y u通過右手坐標系確定。
[0081] 步驟102:根據(jù)步驟101關于圖像坐標系I-XY和像機坐標系0。^。2。的定義，通過 像機標定獲取圖像主點(Cx，C y)、橫向等效焦距Fx、縱向等效焦距Fy。
[0082] 其中，Cx、Cy、Fx和Fy均為正實數(shù)。
[0083] 步驟103:根據(jù)步驟101關于標識源坐標系Ou-XuY uZu的定義，獲得Ou-YuZu平面內各 個標識Pi(i = l，2,3,. . .，n)的坐標(Oyi zi)T。
[0084] 其中，η為標識個數(shù)，為正整數(shù)且不小于4;yi、Zl(i = l，2,3,. . .，n)為正實數(shù)。
[0085] 步驟104:測量船艏參考點與船艉參考點的距離L，以及像機安裝位置與船艏參考 點的距離L c。
[0086] 其中，L和Lc均為正實數(shù)。
[0087]步驟105:獲取像機對岸上標識成像時刻的像機航向角P與俯仰角δ。
[0088] 其中，P表示像機光軸與北向的夾角，取值為〇<P<2jt，當光軸與北向重合時為〇， 順時針旋轉逐漸增大;S表示像機光軸與水平面的夾角，取值為向上為正。
[0089] 步驟106:對各個標識P1Q = I，2,3，. . .，n)在圖像中的像點坐標進行提取，記為 (xt V,.)7 (/ = 1,2,3,../?)
[0090] 其中，足和.?,均為正實數(shù)。
[0091] 步驟107:對位姿中間變量的、62、的、以、65、創(chuàng)、的、68進行計算，分如下兩種情況：
[0092] ( I)當標識源個數(shù)為4,即步驟103中的Π = 4時，61、62、63、64、65、66、67、68采用公式 (1) 進行計算：
[0093；
CD
[0094]其中，
yi、zi、^、另（i = l，2,3,4)通過步驟103和步驟106確定。
[0095] (II)當標識源個數(shù)大于4,即步驟三中的n>4時，61、62、63、64、65、66、67、68采用公式 (2) 進行計算：
[0096]
^ 2)
[0097]
yi、zi、^·、^(i = I，2，3，. . .，n)通過步驟103和步驟106確定，在后續(xù)計算中，只用到ei、e3、 Θ4、Θ6、Θ7這五個量。
[0098] 步驟108:計算標識源坐標系Ou-XuYuZ u至像機坐標系Oc-XcYcZc的平移向量[Tx Ty Τζ]τ，計算公式如下：
[0102] 其中，61、63、64、66、67由步驟106確定，(^;上而由步驟102確定。[0103] 步驟109:計算船體坐標系Ob-XbYbZb和標識源坐標系Ou-X uYuZu的歐拉角
[0099]
[0100]
[0101]
[0114] 步驟110:計算離靠泊作業(yè)參數(shù)，包括入泊角β、船艏與岸線距離LB、船艉與岸線距 離LS、船艏相對于岸線的橫向速度V B、船艉相對于岸線的橫向速度VS，計算公式如下：
[0115]
[0116]
[0117]
[0118]
[0119]
[0120] 其中，L和L。由步驟四確定，P和δ由步驟五確定，Tx、Ty、T z由步驟八確定，P由步驟 109確定。
[0121] 步驟111:通過步驟101至步驟110完成第一次離靠泊作業(yè)參數(shù)計算后，判斷是否結 束離靠泊作業(yè)（當船艏與岸線距離、船艉與岸線距離均為零時，結束離靠泊作業(yè)），如果否， 返回到步驟105進行后續(xù)時刻離靠泊作業(yè)參數(shù)計算;如果是，則結束計算。
[0122] 為了便于理解本發(fā)明實施例所述方法，以下將以一具體實例進行說明。
[0123] 如圖2所示，圖2為本實例中離靠泊作業(yè)場景的示意圖，像機1安裝在船的右舷，其 拍攝角度通過旋轉云臺調整，像機1每隔1秒對岸上標識進行一次成像，離靠泊作業(yè)參數(shù)的 更新頻率為IHz，船從靜止狀態(tài)開始實施右舷靠泊，初始時刻船艏參考點2與岸線距離為 16.2米，船艉參考點3與岸線距離為29.3米。
[0124] 基于圖2所示場景，進行離靠泊作業(yè)的過程具體可以包括：
[0125] 步驟一、建立船體坐標系0b-XbYbZ b、圖像坐標系I-XY、像機坐標系Oc-XcYcZ c和標識 源坐標系〇U-XUYUZu。各坐標系的定義如下：
[0126] 船體坐標系Ob-Xb YbZb:原點Ob位于船體質心，Xb軸指向船舶的右舷，Yb軸指向船艏， Zb軸垂直于甲板平面向上，與Xb軸和Yb軸構成右手坐標系。
[0127] 圖像坐標系I-XY:原點I位于圖像的左上角點，X軸沿水平方向指向右，Y軸沿豎直 方向指向下。
[0128] 像機坐標系Oc-XcYcZc:原點Oc位于像機光心，X c軸和Yc軸分別與圖像坐標系的X軸 和Y軸平行，Z。軸沿像機光軸，與平面圖像垂直。
[0129] 標識源坐標系Ou-XuYuZu:原點O u位于泊位參考點，Xu軸垂直于碼頭前沿線，與靠泊 方向一致，Zu垂直于碼頭地面向上，Y u通過右手坐標系確定。
[0130] 步驟二、根據(jù)步驟一關于圖像坐標系I-XY和像機坐標系0。^。2。的定義，通過像 機標定獲取圖像主點(Cx，Cy )、橫向等效焦距Fx、縱向等效焦距Fy。
[0131] 其中，Cx、Cy、Fx和F y均為正實數(shù)。
[0132] 在本實施例中，Cx和Cy均為300像素，F(xiàn)x和F y均為200像素。
[0133] 步驟三、根據(jù)步驟一關于標識源坐標系Ou-Xu YuZu的定義，獲得Ou-YuZu平面內各個 #KPi(i = l，2,3，...，n；^*#(0yiZi)T。
[0134] 其中，η為標識個數(shù)，為正整數(shù)且不小于4;yi、Zl(i = l，2,3,. . .，n)為正實數(shù)。
[0135] 在本實施例中，岸上標識的安裝如圖3所示，η = 4;yi = 2米，Zi = I米;y2 = 3米，Z2 = 6米；y3 = 6米，Z3 = 5米；y4 = 7米，Z4= 2米。
[0136] 步驟四、測量船艏參考點2與船艉參考點3的距離L，以及像機安裝位置與船艏參考 點1的距離U。
[0137] 其中，L和Lc均為正實數(shù)。
[0138] 在本實施例中，L=150米，Lc = 50米。
[0139] 步驟五、獲取像機對岸上標識成像時刻的像機航向角P與俯仰角δ。
[0140] 其中，P表示像機光軸與北向的夾角，取值為0<P<2jt，當光軸與北向重合時為〇， 順時針旋轉逐漸增大;S表示像機光軸與水平面的夾角，取值為-
句上為正。
[0141] 在本實施例中，Ρ = 85°，δ = 〇。
[0142] 步驟六、對各個標識P1Q = Ijj, . . .，η)在圖像中的像點坐標進行提取，記為 {xt V )7 (/ = 1,2,3,,..,?)...
[0143] 其中，鳥和免.均為正實數(shù)。
[0144] 在本實施例中，·^=2660像素，另=]480像素；毛=2640像素，艿=1380像素； .?= 258〇像素，艿=HOO像素;i4= 256〇像素，夕4 = Μ?Ο像素。
[0145] 步驟七、對位姿中間變量ei、e2、e3、e4、e 5、e6、e7、e8進行計算，分如下兩種情況：
[0146] (I)當標識源個數(shù)為4，即步驟三中的η = 4時：
[0152]在本實例中，采用（I)的方法進行計算，ei = -20、e2 = 0、e3 = 2700、e4 = 0、e5 = -20、 e6= 1500、e7 = 0、e8 = 0〇
[0153] 步驟八、計算標識源坐標系Ou-XuYuZ u至像機坐標系Oc-XcYcZc的平移向量[Tx Ty Tz ]τ，計算公式如下：
[0154]
[0155]
[0156]
[0157] 其中，ei、e3、e4、e6、e7由步驟六確定，0\、〇7、?\、？7由步驟二確定。
[0158] 在本實例中，通過式(22)-式(24)計算得Tx=120米，Ty = 60米，Tz = IO米。
[0159] 步驟九、計算船體坐標系Ob_XbYbZb和標識源坐標系Ou-XuYuZu的歐拉角/於). :， 計算公式如下：
[0160]
[0161]
[0162]
[0163]
[0164]
[0165]
[0166]
[0167]
[0168]
[0169]
[0170] 在本實施例中，通過式(25)-式(33)計算得θ = 〇, γ =0, P =
[0171]步驟十、計算離靠泊作業(yè)參數(shù)，包括入泊角β、船艏與岸線距離Lb、船艉與岸線距離 Ls、船艏相對于岸線的橫向諫度Vr、船艉相對于岸線的橫向諫度Vs，計筧公式如下：
[0172]
[0173]
[0174]
[0175]
[0176] Vs =.LS (38)
[0177] 其中，L和Lc由步驟四確定，P和δ由步驟五確定，Tx、T y、Tz由步驟八確定，P由步驟九 確定。
[0178] 在本實施例中，經(jīng)式（34)-式（38)計算得β = 5°，Lb=16.06米，Ls = 29.14米，Vb = 0.14米/秒，Vs = O. 16米/秒。
[0179] 步驟十一、通過步驟一至步驟十完成第一次離靠泊作業(yè)參數(shù)計算后，判斷是否結 束離靠泊作業(yè)，如果否，返回到步驟五進行后續(xù)時刻離靠泊作業(yè)參數(shù)計算;如果是，則結束 計算。
[0180] 接下來結合附圖對本發(fā)明實施例所述裝置進行詳細說明。
[0181] 構建單元，用于預先建立船體坐標系0b-XbYbZb、圖像坐標系I-XY、像機坐標系O c-XcYcZc和標識源坐標系Ou-XuYuZ u;
[0182] 測量單元，用于測量船艏參考點與船艉參考點的距離L，以及像機安裝位置與船艏 參考點的距離Lc;
[0183] 獲取單元，用于獲取像機對岸上標識成像時刻的像機航向角P與俯仰角δ;
[0184] 計算單元，用于計算標識源坐標系Ou-XuYuZ u至像機坐標系Oc-XcYcZc的平移向量[T x Ty Τζ]τ;以及計算船體坐標系Ob-XbYbZb和標識源坐標系O u-XuYuZu的歐拉聲
以及 根據(jù)上述參數(shù)計算離靠泊作業(yè)參數(shù)，該離靠泊作業(yè)參數(shù)包括:入泊角β、船艏與岸線距離Lb、 船艉與岸線距離Ls、船艏相對于岸線的橫向速度Vb、船艉相對于岸線的橫向速度Vs。
[0185] 該計算單元的具體計算過程主要包括：
[0186] 計算單元計算標識源坐標系Ou-XuYuZ u至像機坐標系0。-?(。￥。2。的平移向量[1\丁7 Τζ]τ：
[0187] 根據(jù)圖像坐標系I-XY和像機坐標系Oc-XcYcZc的定義，通過像機標定獲取圖像主點 (C x，Cy )、橫向等效焦距Fx、縱向等效焦距Fy;
[0188] 計算位姿中間變量ei、e3、e4、e 6、e7;
[0189] 根據(jù)圖像主點（Cx，Cy)、橫向等效焦距Fx、縱向等效焦距F y以及位姿中間變量，計算 計算標識源坐標系Ou-XuYuZ u至像機坐標系Oc-XcYcZc的平移向量[Tx Ty Τζ]τ。
[0190] 計算船體坐標系Ob-XbYbZb和標識源坐標系Ou-Xu YuZu的歐拉：

[0191]
[0192]
[0193]
[0194]
[0195]
[0196]
[0197]
[0198]
[0199]
[0200]
[0201]
[0202]
[0203]
[0204]
[0205]
[0206]
[0207] 對于計算單元的具體實現(xiàn)過程，由于上述方法中已有詳細說明，故此處不再贅述。
[0208] 判斷單元，用于根據(jù)離靠泊作業(yè)參數(shù)判斷是否結束離靠泊作業(yè)，如果否，重新獲取 像機對岸上標識成像時刻的像機航向角P與俯仰角δ，觸發(fā)獲取單元重新獲取像機對岸上標 識成像時刻的像機航向角P與俯仰角S，計算單元再次進行離靠泊作業(yè)參數(shù)計算，直到離靠 泊作業(yè)結束;如果是，則結束計算。
[0209] 綜上所述，本發(fā)明實施例提供了一種基于機器視覺的離靠泊作業(yè)參數(shù)計算裝置， 一是考慮了離靠泊作業(yè)參數(shù)與像機航向角及俯仰角的耦合關系，允許離靠泊作業(yè)過程中手 動或自動調整像機角度，保證岸上標識能夠在有限的像機視場范圍內成像，放寬了對像機 視場、船岸位姿關系的約束，提高了離靠泊參數(shù)解算精度;二是給出了基于四個及四個以上 共面標識源的離靠泊作業(yè)參數(shù)計算方法，計算過程簡單，運算量小，減小了實時運算對計算 機資源的要求。
[0210] 本領域技術人員可以理解，實現(xiàn)上述實施例方法的全部或部分流程，可以通過計 算機程序來指令相關的硬件來完成，所述的程序可存儲于計算機可讀存儲介質中。其中，所 述計算機可讀存儲介質為磁盤、光盤、只讀存儲記憶體或隨機存儲記憶體等。
[0211]雖然已經(jīng)詳細說明了本發(fā)明及其優(yōu)點，但是應當理解在不超出由所附的權利要求 所限定的本發(fā)明的精神和范圍的情況下可以進行各種改變、替代和變換。而且，本申請的范 圍不僅限于說明書所描述的過程、設備、手段、方法和步驟的具體實施例。本領域內的普通 技術人員從本發(fā)明的公開內容將容易理解，根據(jù)本發(fā)明可以使用執(zhí)行與在此所述的相應實 施例基本相同的功能或者獲得與其基本相同的結果的、現(xiàn)有和將來要被開發(fā)的過程、設備、 手段、方法或者步驟。因此，所附的權利要求旨在它們的范圍內包括這樣的過程、設備、手 段、方法或者步驟。
[0212]以上所述，僅為本發(fā)明較佳的【具體實施方式】，但本發(fā)明的保護范圍并不局限于此， 任何熟悉本技術領域的技術人員在本發(fā)明揭露的技術范圍內，可輕易想到的變化或替換， 都應涵蓋在本發(fā)明的保護范圍之內。
【主權項】
1. 一種基于機器視覺的離靠泊作業(yè)參數(shù)計算裝置，其特征在于，包括： 構建單元，用于預先建立船體坐標系Ob-XbYbZb、圖像坐標系I-XY、像機坐標系Oc-XcY cZc 和標識源坐標系0u_XuYuZu ; 測量單元，用于測量船艏參考點與船艉參考點的距離L，以及像機安裝位置與船艏參考 點的距離Lc; 獲取單元，用于獲取像機對岸上標識成像時刻的像機航向角P與俯仰角h 計算單元，用于計算標識源坐標系〇u-XuYuZu至像機坐標系0 C-XCYCZC的平移向量[Tx Ty Τζ]τ;以及計算船體坐標系Ob-XbYbZb和標識源坐標系〇u-xuY uzu的歐拉角(0，爐f ;以及根 據(jù)上述參數(shù)計算離靠泊作業(yè)參數(shù)； 判斷單元，用于根據(jù)離靠泊作業(yè)參數(shù)判斷是否結束離靠泊作業(yè)，如果否，重新獲取像機 對岸上標識成像時刻的像機航向角P與俯仰角δ，觸發(fā)獲取單元，直到離靠泊作業(yè)結束;如果 是，則結束計算。2. 根據(jù)權利要求1所述的裝置，其特征在于，所述離靠泊作業(yè)參數(shù)包括： 入泊角β、船艏與岸線距離Lb、船艉與岸線距離Ls、船艏相對于岸線的橫向速度VB、船艉 相對于岸線的橫向速度Vs。3. 根據(jù)權利要求1所述的裝置，其特征在于，所述計算單元根據(jù)如下公式計算離靠泊作 業(yè)參數(shù)： β-φ LB = TxC〇sp+Tysinpsin5+Tzsinpcos5-LcsinP Ls = LB+Lsin0 ^ = 4 ο4. 根據(jù)權利要求1所述的裝置，其特征在于，所述計算單元計算標識源坐標系0U-XUYUZ U 至像機坐標系OdYcZc的平移向量[Tx Ty 1^的過程具體包括： 根據(jù)圖像坐標系I-XY和像機坐標系Oc-Xc^Z。的定義，通過像機標定獲取圖像主點（cx, Cy)、橫向等效焦距Fx、縱向等效焦距Fy; 計算位姿中間變量ei、Θ3、Θ4、Θ6、Θ7 ; 根據(jù)圖像主點（Cx，Cy)、橫向等效焦距Fx、縱向等效焦距F y以及位姿中間變量，計算計算 標識源坐標系〇u-XuYuZu至像機坐標系Oc-XcYcZc的平移向量[T x Ty Τζ]τ。5. 根據(jù)權利要求1所述的方法，其特征在于，所述計算單元計算船體坐標系Ob-XbYbZb和 標識源坐標系〇u-XuYuZu的歐拉角@ 的過程具體包括： 9. sin_1[ (r6sin5+r2C〇s5)cosp-r4sinp]其中，1"1、12、^4、^6通過以下公式確定：
【文檔編號】G06T7/00GK106056621SQ201610424343
【公開日】2016年10月26日
【申請日】2016年6月15日
【發(fā)明人】王清哲, 趙甲文, 王宇, 王玉璽, 白曉勇
【申請人】中國船舶工業(yè)系統(tǒng)工程研究院