田相才 王懷志

上海振華重工(集團(tuán))股份有限公司

1 引言

隨著無(wú)人駕駛和智能化發(fā)展的逐漸成熟,國(guó)內(nèi)已建成多個(gè)高度智能化的自動(dòng)化碼頭,例如廈門遠(yuǎn)海自動(dòng)化碼頭、青島新前灣自動(dòng)化碼頭、洋山四期自動(dòng)化碼頭等。上述碼頭的自動(dòng)化導(dǎo)引車都采用磁釘導(dǎo)航技術(shù),需要在港口水平運(yùn)輸區(qū)域的地面埋設(shè)大量的磁釘,對(duì)于碼頭基建要求較高。分布在車輛前后端底部的定位磁釘天線價(jià)格昂貴,維修成本也比較高。隨著老碼頭升級(jí)改造成自動(dòng)化碼頭需求的日益增長(zhǎng),磁釘定位方案已經(jīng)不適用。

為解決以上問(wèn)題,設(shè)計(jì)一種自動(dòng)化碼頭導(dǎo)引車(以下簡(jiǎn)稱IGV)車載組合定位系統(tǒng)的標(biāo)定方法。該方法有效利用PDCA質(zhì)量改進(jìn)方法工具,提升標(biāo)定質(zhì)量;標(biāo)定成功后,可以利用北斗導(dǎo)航系統(tǒng)與慣性導(dǎo)航組合的方式與里程計(jì)信息輸入融合,最終獲得穩(wěn)定可靠的高精度導(dǎo)航定位信息。

2 組合定位系統(tǒng)技術(shù)

衛(wèi)星慣性導(dǎo)航組合定位系統(tǒng)主要是指衛(wèi)星導(dǎo)航、慣性導(dǎo)航與里程計(jì)三者的信息融合[1]。在自動(dòng)化碼頭實(shí)際作業(yè)中,北斗衛(wèi)星導(dǎo)航技術(shù)采用高精度的RTK(Real Time Kinematic,實(shí)時(shí)動(dòng)態(tài))定位技術(shù),在IGV中心位置部署數(shù)據(jù)傳輸模塊,可以實(shí)時(shí)從網(wǎng)絡(luò)獲取碼頭基準(zhǔn)站的差分?jǐn)?shù)據(jù),結(jié)合分布在IGV 4個(gè)角的天線數(shù)據(jù),通過(guò)衛(wèi)星導(dǎo)航板卡計(jì)算,最后解算輸出精度達(dá)2～5 cm的RTK定位結(jié)果。其中衛(wèi)星導(dǎo)航天線與板卡的配置結(jié)構(gòu)關(guān)系見(jiàn)圖1。

圖1 衛(wèi)星導(dǎo)航設(shè)備整機(jī)框圖

在衛(wèi)星導(dǎo)航更新時(shí)刻,融合單元會(huì)通過(guò)卡爾曼濾波算法[2]修正慣性導(dǎo)航設(shè)備的誤差,并對(duì)里程計(jì)等外部輸入的刻度因數(shù)進(jìn)行估計(jì),其余時(shí)刻慣性導(dǎo)航設(shè)備進(jìn)行機(jī)械編排來(lái)獲取設(shè)備位置、速度和姿態(tài)的變化量;在車輛靜止時(shí),融合單元會(huì)使用零速修正算法,對(duì)各種誤差進(jìn)行修正;當(dāng)IGV車輛行駛在衛(wèi)星導(dǎo)航信號(hào)質(zhì)量較差區(qū)域時(shí),融合單元會(huì)利用車前向和側(cè)向輸出的速度信息,與慣導(dǎo)設(shè)備計(jì)算的行進(jìn)速度融合,從而有效抑制誤差發(fā)散[3]。

3 多天線定位設(shè)備安裝與計(jì)算

3.1 單天線衛(wèi)星慣性導(dǎo)航組合設(shè)備

為了對(duì)比分析衛(wèi)星慣性導(dǎo)航組合定位系統(tǒng)的性能,在相同慣導(dǎo)器件的情況下,選擇單天線版本在開(kāi)闊環(huán)境進(jìn)行跑車測(cè)試,未進(jìn)行里程計(jì)融合。經(jīng)過(guò)測(cè)試,單天線衛(wèi)星慣性導(dǎo)航組合設(shè)備在開(kāi)闊環(huán)境下,航向與基準(zhǔn)的誤差不超過(guò)0.28°,定位結(jié)果與基準(zhǔn)位置的誤差在25 cm以內(nèi)。如果在碼頭的堆場(chǎng)和裝卸作業(yè)區(qū)域,導(dǎo)航性能會(huì)更差,不能滿足港口IGV的運(yùn)行要求,故采用多天線布置方案。

3.2 多天線定位設(shè)備安裝

在IGV的車體4個(gè)角安裝衛(wèi)星天線,將相應(yīng)的衛(wèi)星天線電纜連接到衛(wèi)星天線的TNC插座上。因?yàn)檐囕v和衛(wèi)星天線支架存在加工誤差,為保證衛(wèi)星定向結(jié)果與車輛方向一致,需要在安裝衛(wèi)星天線之后對(duì)衛(wèi)星天線支架進(jìn)行調(diào)整。借助全站儀或者其他設(shè)備,將左前左后衛(wèi)星天線的連線與車輛一側(cè)的方向偏差調(diào)整到0.1°以內(nèi)。衛(wèi)星天線支架安裝位置,要與車體保持安全距離,防止異常情況下被放下的集裝箱砸壞。

3.3 中心坐標(biāo)計(jì)算

設(shè)備內(nèi)接收機(jī)能夠獲取4個(gè)天線在大地坐標(biāo)系下的高精度定位。車輛靜止時(shí),采集一段時(shí)間的靜態(tài)定位數(shù)據(jù),然后采取平滑后的定位數(shù)據(jù)作為準(zhǔn)確定位。假設(shè)天線的坐標(biāo)為:左前天線(x1,y1)、左后(x2,y2)、右后(x3,y3)和右前(x4,y4)。計(jì)算相鄰兩點(diǎn)的距離p1、p2。最后以矩形中心(即設(shè)備安裝位置)為原點(diǎn),確定4個(gè)天線的桿臂坐標(biāo)值,左前天線桿臂(p1/2,-p2/2)、左后天線(-p1/2,-p2/2)、右后天線(-p1/2,p2/2)和右前(p1/2,p2/2)(見(jiàn)圖2)。

圖2 尺寸示意圖

只要在使用前完成4個(gè)天線的相對(duì)位置標(biāo)定,即可在以后的使用中通過(guò)衛(wèi)星定位得到4個(gè)天線的坐標(biāo),推算出精確的IGV車輛中心點(diǎn)坐標(biāo),實(shí)現(xiàn)可靠定位。

4 多天線安裝標(biāo)定

4.1 天線標(biāo)定前

設(shè)備安裝完成后,在正常使用前,需要進(jìn)行衛(wèi)星導(dǎo)航4個(gè)天線基線及夾角的標(biāo)定。標(biāo)定過(guò)程需將車輛停放在開(kāi)闊區(qū)域進(jìn)行,保證衛(wèi)星導(dǎo)航4個(gè)天線無(wú)信號(hào)遮擋、干擾,并且整個(gè)過(guò)程保持車輛靜止,以達(dá)到更高的標(biāo)定精度。

4.2 天線標(biāo)定中

在標(biāo)定軟件中查看衛(wèi)星導(dǎo)航板卡RTK解狀態(tài),4個(gè)天線全部顯示為綠色正常,否則為灰色。狀態(tài)都顯示正常后,將工作模式設(shè)置為標(biāo)定模式,然后開(kāi)始標(biāo)定。從“天線標(biāo)定開(kāi)始”狀態(tài)到“天線標(biāo)定中”需等待大約60 s;天線標(biāo)定中狀態(tài)持續(xù)300 s,期間顯示標(biāo)定計(jì)數(shù)與時(shí)間信息,直到顯示“天線標(biāo)定完成”信息。

同時(shí)計(jì)算得到的參數(shù)如天線基線及夾角信息將在顯示框中顯示,確認(rèn)參數(shù)后保存標(biāo)定,可查看北斗解算狀態(tài)(見(jiàn)表1)。解算狀態(tài)若顯示為1或2,則定位可信度較高,允許導(dǎo)引車IGV加入使用。

表1 北斗衛(wèi)星解算狀態(tài)表

4.3 天線標(biāo)定后

根據(jù)方差判斷定位精度,位置的方差越小,定位精度越高。在實(shí)際使用中可根據(jù)位置方差的大小來(lái)判斷定位結(jié)果的精度,決定是否對(duì)其進(jìn)行使用。表2顯示衛(wèi)星慣性導(dǎo)航定位結(jié)果的方差所對(duì)應(yīng)的位置精度。

表2 衛(wèi)星慣性導(dǎo)航定位結(jié)果方差狀態(tài)位說(shuō)明

表2中狀態(tài)位的解釋如下:1指衛(wèi)星導(dǎo)航RTK結(jié)果為固定解,衛(wèi)星慣性導(dǎo)航和里程計(jì)三者組合定位,輸出精度高;2指衛(wèi)星導(dǎo)航RTK結(jié)果為固定解,衛(wèi)星慣性導(dǎo)航兩者組合定位,輸出精度高;3指衛(wèi)星導(dǎo)航RTK結(jié)果為浮點(diǎn)解或單點(diǎn)解,衛(wèi)星導(dǎo)航RTK輸出精度不穩(wěn)定,誤差最大可達(dá)1～2 m;4代表其他解衛(wèi)星慣性導(dǎo)航組合,指衛(wèi)星導(dǎo)航RTK結(jié)果為浮點(diǎn)解或單點(diǎn)解,衛(wèi)星導(dǎo)航RTK輸出精度不穩(wěn)定,誤差最大可達(dá)1～2 m;5為純慣性與里程計(jì)組合,指衛(wèi)星導(dǎo)航無(wú)定位,慣導(dǎo)與里程計(jì)組合輸出,位置保持精度:400 cm/5 s,航向0.5°/5 min;6代表衛(wèi)星導(dǎo)航無(wú)定位,純慣性推算,精度快速發(fā)散,發(fā)散速度約10 cm/s;除上述狀態(tài)位以外,當(dāng)組合出現(xiàn)異常,重新進(jìn)入準(zhǔn)備或?qū)?zhǔn)狀態(tài)。

4.4 標(biāo)定結(jié)果

標(biāo)定完成后,首先檢查天線之間的夾角,4個(gè)角度分別為0°,90°±0.5°,180°±0.5°,90°±0.5°,說(shuō)明天線夾角標(biāo)定正確。然后查看解算狀態(tài)(Status1),解算為1或2,定位精度比較高;最后檢查定位坐標(biāo)、橫坐標(biāo)、縱坐標(biāo),在航向靜態(tài)情況下跳變幅度比較小,坐標(biāo)復(fù)位小于3 cm,航向角幅度小于0.02°,即可認(rèn)為標(biāo)定合格。

5 結(jié)語(yǔ)

對(duì)復(fù)雜環(huán)境下自動(dòng)化碼頭碼頭導(dǎo)引車IGV的北斗衛(wèi)星慣性導(dǎo)航融合定位技術(shù)使用及其標(biāo)定方法進(jìn)行了介紹。該技術(shù)使用北斗高精度RTK位置、速度和定向信息,并且可以對(duì)慣性導(dǎo)航的位置、速度、航向等信息進(jìn)行融合校正并估計(jì)其誤差,最終輸出可靠穩(wěn)定的導(dǎo)航信息。

該方法標(biāo)定過(guò)程節(jié)約人工和時(shí)間,標(biāo)定成功后穩(wěn)定性高,如果安裝天線的位置沒(méi)有發(fā)生變動(dòng),不需要再次標(biāo)定。在某自動(dòng)化碼頭IGV上對(duì)該方法進(jìn)行實(shí)踐應(yīng)用,現(xiàn)場(chǎng)IGV可獲得較高的定位精度,保證IGV作業(yè)的穩(wěn)定性,提升了自動(dòng)化集裝箱碼頭的系統(tǒng)質(zhì)量。