港口物流半實(shí)物仿真中的智能車輛模型設(shè)計(jì)與應(yīng)用

沈立文， 添 玉， 蔣敏敏， 李 航， 范會(huì)方， 范勤勤

（1．上海海事大學(xué)物流工程學(xué)院，上海201306；2．中山大學(xué)南方學(xué)院商學(xué)院，廣州510970；3．上海振華重工智慧產(chǎn)業(yè)集團(tuán)智能軟件公司，上海200125）

0 引 言

隨著工業(yè)4．0和中國制造2025戰(zhàn)略的實(shí)施，自動(dòng)導(dǎo)引車輛（Auto guided Vehicle，AGV）越來越多地應(yīng)用在現(xiàn)代制造業(yè)柔性生產(chǎn)線、倉儲(chǔ)物料搬運(yùn)系統(tǒng)、港口碼頭等復(fù)雜工業(yè)領(lǐng)域［1-2］。近年來，具有安全可靠、綠色環(huán)保、高性能、高效率及低運(yùn)營成本等優(yōu)勢的新一代智能港口正加快研發(fā)和推廣應(yīng)用。其中，采用純電動(dòng)無人駕駛的智能運(yùn)輸車輛（Intelligent Guided Vehicle，IGV），集中體現(xiàn)了碼頭智能化的水平，成為行業(yè)和學(xué)術(shù)界研究的焦點(diǎn)。國內(nèi)港口IGV廠商主要產(chǎn)品動(dòng)力來源由最初柴油-液壓馬達(dá)，發(fā)展為柴油-鋰電池以及目前的純鋰電池，如圖1所示。導(dǎo)航方式也由磁釘方式逐漸向多傳感器融合方式演變。目前IGV研發(fā)成本仍然高昂（單機(jī)造價(jià)500萬元以上），技術(shù)難度大，高校無法大批量購買以滿足港口物流教學(xué)研究的需要。由于實(shí)際碼頭生產(chǎn)環(huán)境的復(fù)雜和苛刻安全要求，研究人員很難在真實(shí)場景中進(jìn)行軟件模塊和新算法部署及測試。

圖1 純鋰電IGV

在綠色智慧港口物流研究領(lǐng)域，大多數(shù)學(xué)者均采用靜態(tài)解析方法進(jìn)行研究，開展數(shù)值模擬或統(tǒng)計(jì)分析實(shí)驗(yàn)，評估所建立的模型或算法設(shè)計(jì)的有效性［3-7］。港口物流系統(tǒng)是一類人機(jī)結(jié)合的復(fù)雜動(dòng)態(tài)系統(tǒng)，具有時(shí)間和空間跨度大、各組成部分關(guān)聯(lián)性強(qiáng)，多目標(biāo)相互制衡等顯著特點(diǎn)。定性分析因其結(jié)果模糊性難以勝任，一般的定量分析也無法應(yīng)對復(fù)雜多變的場景。通過演繹方法直接進(jìn)行數(shù)學(xué)建模相當(dāng)困難，而且越來越暴露出局限性：模型和算法的復(fù)雜度較高，適應(yīng)性、可移植性、可擴(kuò)展性低，難以在實(shí)際系統(tǒng)推廣應(yīng)用［8］。半實(shí)物仿真代表系統(tǒng)仿真的新趨勢，在交通工程領(lǐng)域Urbanik等［9］首次提出交通控制硬件在環(huán)仿真，隨后更多學(xué)者關(guān)注交通仿真領(lǐng)域［10-12］。港口領(lǐng)域缺乏全局物流系統(tǒng)的半實(shí)物仿真應(yīng)用，僅用于單機(jī)控制器測試［13］、堆場安全和邏輯控制仿真系統(tǒng)［14］、碼頭設(shè)備模擬器［15］、軟件開發(fā)測試和設(shè)備模擬操作培訓(xùn)［16］等，但鮮有達(dá)到無人自主系統(tǒng)協(xié)同調(diào)度的新高度。

綜上，本文提出一套低成本、可擴(kuò)展的輕量級微縮版智能車輛模型及其軟件方案，用于港口物流系統(tǒng)的半實(shí)物仿真、算法驗(yàn)證等，同時(shí)又可用于教育培訓(xùn)和交流展示。

1 結(jié)構(gòu)設(shè)計(jì)原理

智能車輛模型以新一代智能集裝箱碼頭中使用的典型IGV為原型，同時(shí)考慮實(shí)驗(yàn)場地的區(qū)域條件約束，按1∶50比例縮放。機(jī)械結(jié)構(gòu)設(shè)計(jì)主要經(jīng)歷輪系結(jié)構(gòu)設(shè)計(jì)、轉(zhuǎn)向架設(shè)計(jì)、總體結(jié)構(gòu)設(shè)計(jì)以及裝配優(yōu)化等階段，兼顧車體結(jié)構(gòu)強(qiáng)度、美觀、加工與裝配難度等方面。

1.1 輪系結(jié)構(gòu)設(shè)計(jì)

輪系結(jié)構(gòu)設(shè)計(jì)采用4輪分布式電動(dòng)機(jī)驅(qū)動(dòng)方案，即驅(qū)動(dòng)電動(dòng)機(jī)與車輪集成，由4個(gè)電動(dòng)機(jī)獨(dú)立驅(qū)動(dòng)4個(gè)車輪。選用減速機(jī)構(gòu)與測速編碼器集成的GM12-N20微型電動(dòng)機(jī)，編碼器為AB雙相增量式磁性霍爾編碼器。相比傳統(tǒng)燃油驅(qū)動(dòng)和中置電動(dòng)機(jī)驅(qū)動(dòng)，分布式電動(dòng)機(jī)驅(qū)動(dòng)無須變速箱、差速器，節(jié)省了底盤空間，同時(shí)可以獨(dú)立控制每個(gè)車輪轉(zhuǎn)矩，改善車輛控制性能。

1.2 轉(zhuǎn)向架結(jié)構(gòu)設(shè)計(jì)

轉(zhuǎn)向架結(jié)構(gòu)設(shè)計(jì)采用梯形轉(zhuǎn)向架，前后橋可以同時(shí)向同一側(cè)轉(zhuǎn)向?qū)崿F(xiàn)橫行，或者同時(shí)向兩側(cè)轉(zhuǎn)向以縮小轉(zhuǎn)彎半徑。近似滿足純滾動(dòng)的阿克曼轉(zhuǎn)向原理［3］，如圖2所示。

圖2 轉(zhuǎn)向架示意圖

轉(zhuǎn)向架兩側(cè)車輪轉(zhuǎn)向角關(guān)系為：

式中：AD為梯形架對角線；k為軸長；m為梯形臂長；θ1、θ2分別為左、右轉(zhuǎn)向角；α為梯形原始角；p為橫拉桿長；t為輪胎厚度。

1.3 總體結(jié)構(gòu)設(shè)計(jì)

總體結(jié)構(gòu)主要分為底盤、前后面板、前后橋、側(cè)面板、電池倉、PCB倉與頂蓋7個(gè)部分，如圖3所示。為使車輛重心更接近地面，將電池倉直接置于底盤中央，PCB倉置于電池倉上層，前后面板用于固定攝像機(jī)模塊與燈光模塊，并預(yù)留充電接口。其中，前后面板、側(cè)面板與前后橋部分零件使用SLA樹脂工藝3D打印加工。為降低成本，底盤、頂蓋與前后橋部分零件使用3 mm厚度亞克力激光切割工藝加工。最終參數(shù)見表1。

圖3 智能車輛模型實(shí)物圖

表1 智能車輛模型基本參數(shù)

2 導(dǎo)航控制方案設(shè)計(jì)

2.1 主控方案設(shè)計(jì)

主控電路由樹莓派3B主板、電源、電動(dòng)機(jī)驅(qū)動(dòng)、AVR單片機(jī)組成，原理如圖4所示。除主板外均集成在單片雙層PCB內(nèi)，PCB預(yù)留2路MFRC522射頻識(shí)別模塊接口、4路電動(dòng)機(jī)驅(qū)動(dòng)及編碼器接口、2路數(shù)碼舵機(jī)接口、4路RGB燈光模塊接口、雙電池供電接口、單片機(jī)串口和單片機(jī)ICSP接口［12］。

圖4 主控電路原理圖

2.2 定位導(dǎo)航方案設(shè)計(jì)

車底盤前后安裝射頻識(shí)別（Radio Frequensy Idenification，RFID）模塊，采集地面鋪設(shè)的標(biāo)簽信息。車輛模型前后各安裝一個(gè)單目攝像頭，平視道路前方，通過識(shí)別道路標(biāo)識(shí)線的方式進(jìn)行偏差糾正與導(dǎo)航控制。上位機(jī)根據(jù)業(yè)務(wù)需求不斷為各RFID標(biāo)簽綁定新的行駛指令，讀取到RFID標(biāo)簽后配合視覺信息，可以在相應(yīng)位置進(jìn)行直行、轉(zhuǎn)向、換道等操作。

視覺部分采用60幀480 p無畸變攝像頭采集道路圖像信息，原始圖像依次經(jīng)過灰度化處理、高斯模糊、邊緣檢測、霍夫變換、透視變換，分別如圖5～8所示，從中提取出道路標(biāo)識(shí)線中的直線段，用于調(diào)整車身姿態(tài)。

圖5 320×110分辨率灰度圖

圖6 5×5高斯模糊

圖7 Canny邊緣檢測圖像

圖8 透視點(diǎn)標(biāo)定圖

為使轉(zhuǎn)彎半徑盡可能小，在開始轉(zhuǎn)向時(shí)可設(shè)定前后輪均為最大轉(zhuǎn)角，此時(shí)目標(biāo)道路標(biāo)識(shí)線切換到轉(zhuǎn)向后的車道標(biāo)識(shí)線。以垂直轉(zhuǎn)向?yàn)槔紫刃璐_定車模的姿態(tài)，即車模相對道路標(biāo)識(shí)線的偏差，如圖9所示。

圖9 姿態(tài)偏差示意圖

由于存在攝像頭拍攝地面最近距離，轉(zhuǎn)向過程中需要等待目標(biāo)道路標(biāo)識(shí)線重新出現(xiàn)在攝像頭視野中，隨后偏差調(diào)整按下式計(jì)算：

式中：p為調(diào)整角度；kp為比例系數(shù)；b為視野中線相對道路中線的偏差；ω為位置偏差補(bǔ)償系數(shù)；ek為視野中線與道路中夾角。

智能車輛模型的運(yùn)行速度容易受電池電壓以及干擾因素影響，為獲取較好的行駛穩(wěn)定性，轉(zhuǎn)向時(shí)兩側(cè)車輪需保持相應(yīng)的輪速差，需要對輪速進(jìn)行控制，使用位置式PID控制器對4輪電機(jī)進(jìn)行獨(dú)立控制。

2.3 管理軟件方案設(shè)計(jì)

軟件系統(tǒng)肩負(fù)多車協(xié)同管理、多車監(jiān)控以及邊緣計(jì)算任務(wù)，分為上位機(jī)管理系統(tǒng)、消息中間件、終端管理軟件以及硬件驅(qū)動(dòng)4個(gè)層次，如圖10所示。其中上位機(jī)管理系統(tǒng)采用B／S架構(gòu)，如圖11所示，包含用于狀態(tài)監(jiān)控與管理的Web UI以及Web服務(wù)，并通過消息中間件與終端管理軟件通信，兩者實(shí)現(xiàn)協(xié)同計(jì)算。

圖10 軟件系統(tǒng)架構(gòu)圖

圖11 上位機(jī)管理系統(tǒng)數(shù)據(jù)流圖

監(jiān)控界面如圖12所示，主要可視化車輛電量、系統(tǒng)資源等核心指標(biāo)。車輛終端軟件如圖13所示，需要接受來自上位機(jī)的控制指令，并將指令進(jìn)行解析后通過硬件驅(qū)動(dòng)轉(zhuǎn)換為車輛的實(shí)際動(dòng)作，同時(shí)發(fā)布車速、電量、位置等實(shí)時(shí)數(shù)據(jù)。

圖12 Web端監(jiān)控與管理界面

圖13 車輛終端軟件模塊結(jié)構(gòu)圖

3 實(shí)驗(yàn)和分析

3.1 實(shí)驗(yàn)場景和條件設(shè)定

為了更逼真地模擬智能港口物流系統(tǒng)，驗(yàn)證本文設(shè)計(jì)的智能車輛模型方案，在“現(xiàn)代港口物流”國家級實(shí)驗(yàn)教學(xué)示范中心，以真實(shí)港口工藝為原型搭建一個(gè)標(biāo)準(zhǔn)泊位1∶50場景，并鋪設(shè)RFID定位標(biāo)簽和道路標(biāo)線，布局參數(shù)見表2。其中，基本布局、能源充換區(qū)域、主要集裝箱流方向等與真實(shí)智能碼頭工藝一致，在軟件層面可靈活定義實(shí)驗(yàn)條件和箱區(qū)劃分、交通規(guī)則等，如圖14所示。

表2 場景布局參數(shù)表

實(shí)驗(yàn)場所光照環(huán)境為自然光，室溫約20℃。使用兩車進(jìn)行隨機(jī)車道選擇繞場循環(huán)實(shí)驗(yàn)，在岸橋位置與堆場交換區(qū)位置處停車數(shù)秒模擬接箱送箱。車輛初始充滿電量，統(tǒng)計(jì)道路標(biāo)識(shí)線識(shí)別率、電量消耗、車速、主控CPU占用、主控內(nèi)存占用、主控溫度等。

圖14 實(shí)驗(yàn)場景

3.2 實(shí)驗(yàn)結(jié)果及分析

使用單位時(shí)間內(nèi)捕獲目標(biāo)標(biāo)識(shí)線次數(shù)與拍攝幀數(shù)的比值表示道路標(biāo)識(shí)線的識(shí)別率。實(shí)驗(yàn)1：同時(shí)開啟前后兩路攝像頭，總運(yùn)行時(shí)長15 min，平均幀率為31 f／s，平均識(shí)別率為0．882 3，識(shí)別率低于0．5 的占比為0．013 8，識(shí)別率為0的占比為0。雖然未出現(xiàn)循跡失誤，但幀率不高，動(dòng)態(tài)響應(yīng)稍有延遲。實(shí)驗(yàn)2：測試僅開啟單路攝像頭，與開啟雙路情況進(jìn)行幀率比較，如圖15所示。因開啟雙攝像頭時(shí)大量時(shí)間耗費(fèi)在進(jìn)程切換上，CPU資源占用嚴(yán)重，故建議使用單攝像頭循跡模式，此時(shí)系統(tǒng)內(nèi)存占用穩(wěn)定在50 MB以內(nèi)，尚有較大冗余。

圖15 單攝像頭與雙攝像頭循跡幀率對比圖

采集各電動(dòng)機(jī)轉(zhuǎn)速數(shù)據(jù)進(jìn)行分析，以典型直行轉(zhuǎn)彎再直行工況為例，截取一段加速啟動(dòng)后前后舵機(jī)同向滿舵轉(zhuǎn)向，最后減速停車全過程中4個(gè)電動(dòng)機(jī)速度曲線，如圖16所示。

圖16 4臺(tái)電動(dòng)機(jī)轉(zhuǎn)速曲線圖

加速啟動(dòng)階段電動(dòng)機(jī)轉(zhuǎn)速波動(dòng)較大且啟動(dòng)存在延遲，原因在于啟動(dòng)時(shí)需要提供較大扭矩，而進(jìn)行PWM調(diào)速時(shí)，當(dāng)占空比尚未達(dá)到能使電動(dòng)機(jī)啟動(dòng)的閾值時(shí)，電動(dòng)機(jī)不運(yùn)轉(zhuǎn)，當(dāng)占空比達(dá)到啟動(dòng)閾值時(shí)PID控制器的積分項(xiàng)已過大，故造成速度波動(dòng)；在減速停車階段由于車輛慣性的存在則沒有此問題。故考慮設(shè)定電動(dòng)機(jī)啟動(dòng)死區(qū)占空比，以避免啟動(dòng)時(shí)上述問題。

進(jìn)行系統(tǒng)壓力測試，開啟兩路攝像頭循跡，不間斷運(yùn)行2 h，電量消耗與系統(tǒng)溫度如圖17所示。系統(tǒng)運(yùn)行穩(wěn)定，CPU溫度維持在安全范圍內(nèi)，滿載情況下雙電池電量消耗速度基本保持一致，最短續(xù)航時(shí)間預(yù)計(jì)約為3．9 h。

圖17 壓力測試數(shù)據(jù)采樣圖

4 結(jié) 語

針對智慧港口物流研究中的原型車輛研發(fā)難度大、成本高，且真實(shí)環(huán)境難以開展系統(tǒng)性試驗(yàn)等問題，本文研制了試驗(yàn)用微縮版智能車輛模型，設(shè)計(jì)了射頻識(shí)別融合機(jī)器視覺導(dǎo)引和系統(tǒng)管理方案并成功實(shí)施。提供的軟件集成開發(fā)環(huán)境，可作為智能港口、無人自主系統(tǒng)等領(lǐng)域的仿真研究工具，以及實(shí)踐教學(xué)、員工培訓(xùn)平臺(tái)。未來進(jìn)一步研究快速低成本的批量生產(chǎn)方案，設(shè)計(jì)閑時(shí)待機(jī)低功耗模式，并擴(kuò)展與優(yōu)化上位機(jī)功能。

·名人名言·

你們在想要攀登到科學(xué)頂峰之前，務(wù)必把科學(xué)的初步知識(shí)研究透徹。還沒有充分領(lǐng)會(huì)前面的東西時(shí)，就決不要?jiǎng)邮指阃蟮氖虑椤?/p>

——巴甫洛夫