摘 要：為保證斗輪堆取料機全自動系統(tǒng)精度滿足要求，首先明確該全自動系統(tǒng)中三個坐標系的數(shù)學(xué)關(guān)系，其次確定關(guān)鍵位置的標定方法，然后確定系統(tǒng)精度的驗證方法。系統(tǒng)標定和驗證主要采用全站儀多點多次測量的方式進行，結(jié)果表明該種方法可以準確校正系統(tǒng)偏差。

關(guān)鍵詞：斗輪堆取料機全自動系統(tǒng)；坐標系；標定方法；驗證方法

中圖分類號：U653.928.+5 文獻標識碼：A 文章編號：1001-0785（2020）02-0058-05

0 引言
是否安裝激光掃描、激光定位系統(tǒng)是衡量碼頭或港口設(shè)備智能化、自動化程度的一個重要技術(shù)指標。激光掃描或定位系統(tǒng)具有測量實時性高、掃描精度高、檢測距離遠、受環(huán)境影響小、技術(shù)水平成熟等優(yōu)點。而判斷激光掃描或定位系統(tǒng)優(yōu)劣的一個關(guān)鍵參數(shù)和重要指標是全自動系統(tǒng)的精度。要保證全自動系統(tǒng)精度，要明確全自動系統(tǒng)中存在的三個坐標系及坐標系間的關(guān)系，要標定好全自動系統(tǒng)中幾個關(guān)鍵位置參數(shù)，然后在上述基礎(chǔ)上進行實際驗證。

全站型電子測距儀（以下簡稱全站儀），是一種利用光電測距原理，集水平角、垂直角、距離（斜距、平距）、高差測量功能于一體的測繪儀器系統(tǒng)，因其僅需一次安置儀器就可完成該測站上全部測量工作而被稱作全站儀。

1 全自動系統(tǒng)坐標系界定及關(guān)系
在堆取料自動化系統(tǒng)中，存在三個坐標系，分別為大機坐標系、激光掃描系統(tǒng)坐標系和堆場坐標系，三個坐標系的關(guān)系如圖1 所示。

圖 1 三個坐標系的關(guān)系

1.1 大機坐標系
大機坐標系，即堆取料機自身各個機構(gòu)的位置組成的三維坐標系，包括大車、回轉(zhuǎn)和俯仰等主要機構(gòu)的位置，也是控制系統(tǒng)軟件控制本機機構(gòu)動作、保證本機設(shè)備安全范圍直接使用的坐標系。

1.2 激光掃描系統(tǒng)坐標系
激光掃描系統(tǒng)坐標系如圖2 所示，包括原始球坐標數(shù)據(jù)和激光掃描三維坐標系。激光掃描系統(tǒng)中，各個激光器直接掃描得到的數(shù)據(jù)點云為球坐標形式（r，θ，φ）。單個點（r，θ，φ）中，r 為激光器掃描返回距離，θ 為激光單線掃描中掃描角度，φ 為激光掃描裝置轉(zhuǎn)動機構(gòu)轉(zhuǎn)動角度( 對不帶轉(zhuǎn)動機構(gòu)的激光掃描裝置，φ=0 )。激光掃描系統(tǒng)通過將球坐標轉(zhuǎn)換為三維直角坐標的形式，得到激光掃描系統(tǒng)坐標系下的激光點云。

圖 2 YPSS 坐標系與YPSS 原始數(shù)據(jù)

堆取料機全自動系統(tǒng)需要安裝4 套激光器，分別為2 套安裝于臂架前端兩側(cè)的2D 激光器，2 套安裝于梯形架上平臺兩側(cè)的3D 激光器，具體安裝位置如圖3 和圖4 所示。由于4 套系統(tǒng)安裝位置的不同，坐標系之間的關(guān)系需要通過全站儀標定確認。

圖 3 2D 掃描激光器安裝位置

圖 4 3D 掃描激光器安裝位置

設(shè)定球坐標系坐標(r, θ, φ)，三維直角坐標(x, y, z)，有

圖 5 球坐標三維直角坐標

1.3 堆場坐標系
堆場坐標系，指堆場中的三維直角坐標系，通常用于堆場的管理使用。一般以大車沿軌道前進方向為X 軸正向，垂直于軌道向堆場方向為Y 軸正向，豎直向上方向為Z 軸正向。其中0 點位置設(shè)置，大車后停止位置為X 軸0 點，大車軌道的中心線作為Y 軸的0 點，堆場的最低點作為Z 軸的0 點。

1.4 坐標系間數(shù)學(xué)關(guān)系
1）激光掃描系統(tǒng)坐標系轉(zhuǎn)化為堆場坐標系定義激光掃描系統(tǒng)坐標系為YPSS 坐標系，定義堆場坐標系為Yard 坐標系，則二者間的數(shù)學(xué)關(guān)系如下

或簡寫為

式中：Pyard 為堆場坐標系，Pypss 為YPSS 坐標系。R為旋轉(zhuǎn)，T 為平移，R、T 與本機當時機構(gòu)位置( 主要包括大車位置、回轉(zhuǎn)角度、俯仰角度) 和標定數(shù)據(jù)有關(guān)。
2）大機坐標系和堆場坐標系間的轉(zhuǎn)換大機幾個主要的參數(shù)得位置關(guān)系如圖6 所示。

根據(jù)式（4）~ 式（7）可分別求得回轉(zhuǎn)角度、俯仰角度和大車位置。

圖 6 坐標系關(guān)鍵參數(shù)示意圖

2 全自動系統(tǒng)標定方法
為保證標定的可靠性，采用全站儀和反射片對關(guān)鍵位置進行多點多次標定，包括基準標定、臂架定點標定和激光器標定。標定過程中，兩個基準點位置不可以變化移動，對于設(shè)備不同位置的標定需要開啟全站儀的搬站功能，保證全站儀更換位置后測量基準前后一致。

2.1 基準標定
在軌道上貼2 個反光片作為基點O1 和O2，調(diào)整全站儀，建立坐標系。O1 和O2 點作為基準點。全站儀距離堆取料機及軌道盡可能的遠，減小后續(xù)測量誤差。兩基點的連線為X 軸，Y 軸位于垂直軌道的水平方向，Z 軸垂直水平面向上。

2.2 臂架定點標定
如圖7 所示，沿懸臂左側(cè)長度方向貼2 個反光片M和N，兩點之間的距離選取大一些，注意MN 連線要與懸臂保持平行，用同樣的方式再標定臂架右側(cè)。

圖 7 懸臂貼片

2.3 激光器標定
如圖8 所示，在激光器（或者轉(zhuǎn)動機構(gòu)）外側(cè)貼3個反光片，其中2 個與激光器掃描方向平行，2 個與掃描方向垂直。

（a）左側(cè)3D 激光器

圖 8 激光器貼片

表1 為堆取料機4 臺激光器及主要機械參數(shù)的標定結(jié)果。

3 精度驗證方法
選取固定料堆對象，利用全站儀對堆垛邊界的典型位置進行標定，分別對應(yīng)不同的俯仰角度或者回轉(zhuǎn)角度，測得多組數(shù)據(jù)，通過人工計算或者智能計算與編碼器值進行比較，完成編碼器的標定。測量的料堆輪廓如圖9所示。

圖 9 測試料堆輪廓圖

3D 激光器的驗證需要考慮三種情況
1）單機靜止狀態(tài)下，利用3D 掃描儀轉(zhuǎn)動掃描物料，保存物料的三維數(shù)據(jù)并對全站儀標定的物料參數(shù)進行計算比較，驗證此種測量模式的測量精度。
2）3D 掃描儀在機械零點位置，單機大車移動，對物料進行掃描測量，保存三維數(shù)據(jù)并與全站儀標定的物料參數(shù)進行計算比較，驗證此種測量模式的測量精度。
3）2D 掃描儀在機械零點位置，堆取料機懸臂擺動，對堆垛進行掃描測量，保存三維數(shù)據(jù)并與全站儀標定的參數(shù)進行計算比較，驗證此種測量模式的測量精度。經(jīng)測試和參數(shù)調(diào)整，全自動系統(tǒng)的精度滿足全自動系統(tǒng)精度技術(shù)指標要求（偏差＜ 20 cm），如表2 所示，掃描偏差≤ 11 cm，滿足全自動功能要求。

4 總結(jié)
在理清堆取料機全自動系統(tǒng)中三個坐標系之間的數(shù)學(xué)關(guān)系后，將相關(guān)計算融合進全自動軟件，通過對系統(tǒng)中關(guān)鍵位置進行精確標定，確定相關(guān)激光器的姿態(tài)參數(shù)，再通過標定料堆高度，與全自動掃描數(shù)據(jù)進行比較，從而完成全自動系統(tǒng)的精度驗證。通過精度驗證確保了全自動堆取料機激光掃描系統(tǒng)的掃描精度，從而確保堆取料機的全自動運行。

由于堆取料機回轉(zhuǎn)、大車等機構(gòu)本身存在回程間隙，全自動系統(tǒng)精度的進一步提高還需要機械方面的加工和安裝精度進一步提高。