水下浮游探測器系統(tǒng)設(shè)計與實現(xiàn)*

國核電站運行服務(wù)技術(shù)公司 沈杰 趙琛 王一帆 李思穎

AP1000三代核電站的余熱排出熱交換器水箱需進行周期性的目視檢查，由于環(huán)境復(fù)雜且具有輻射性，必須通過水下探測設(shè)備進行遠程檢查。本文設(shè)計了一種能夠自由定深、運行平穩(wěn)，攜帶攝像系統(tǒng)，監(jiān)視、監(jiān)測和記錄余熱排出熱交換器水箱目視檢查全過程的水下浮游探測器系統(tǒng)，通過對設(shè)計方案的具體闡述，模塊化方式處理各個控制部件，開發(fā)出了相應(yīng)的控制軟件?，F(xiàn)場測試表明，該系統(tǒng)性能穩(wěn)定，實用性強，達到了設(shè)計要求，具有一定的應(yīng)用前景。

隨著自動控制技術(shù)和核電技術(shù)的迅速發(fā)展，水下機器人技術(shù)被廣泛應(yīng)用于核工業(yè)應(yīng)用領(lǐng)域，特別是在有放射性的核環(huán)境下，通過工作人員遠程控制水下機器人完成相應(yīng)的無損檢測的任務(wù)，從而有效減少現(xiàn)場作業(yè)人員的輻射傷害和減輕工作負擔，且能提高無損檢測效率和準確性[1-4]。

根據(jù)AP1000三代核電站自主檢查大綱要求，需要在運行周期內(nèi)對余熱排出熱交換器等非能動安全系統(tǒng)重要部件進行水箱內(nèi)周向三側(cè)全面目視檢查[5-6]。該水箱為封閉式水箱，只有一個通道可以進入，水箱總體高度約為10m，停堆檢查時水位高度約為5m，人員無法進入水箱內(nèi)檢查，且無法用長柄工具實現(xiàn)檢查[7]。為有效完成余熱排出熱交換器水箱目視檢查，需開發(fā)一套水下浮游探測器系統(tǒng)。

1 控制系統(tǒng)設(shè)計要求

為有效完成余熱排出熱交換器水箱目視檢查，在市面上現(xiàn)有水下富有探測系統(tǒng)基礎(chǔ)上總結(jié)經(jīng)驗，分析原有設(shè)計缺陷，對現(xiàn)有水下浮游探測器系統(tǒng)進行改進。本文所提出的水下浮游探測器能夠自由定深、運行平穩(wěn)，攜帶攝像系統(tǒng)，監(jiān)視、監(jiān)測和記錄余熱排出熱交換器水箱目視檢查全過程，自帶照明系統(tǒng)，滿足本身攝像及作業(yè)所需要的光照強度，并能執(zhí)行異物拾取等任務(wù)。

水下浮游探測器系統(tǒng)的設(shè)計要求以下幾項：（1）保持推進器螺旋槳推進力持續(xù)運行；（2）改變視頻清晰度低，亮度低，可視距離較短的缺陷；（3）高集成度控制系統(tǒng)，體積小，重量輕，便于使用和運輸；（4）具備數(shù)據(jù)存儲系統(tǒng)，并具有外聯(lián)接口；（5）良好定深性能，懸停性能優(yōu)化。

2 水下浮游探測器系統(tǒng)總體方案

2.1 總體組成

完整的浮游器總體包括浮游式潛水器本體、水面支持設(shè)備（控制箱、便攜式控制盒等）和臍帶絞車及臍帶電纜，浮游器系統(tǒng)總體組成圖如圖1所示。

圖1 浮游式潛水器總體組成Fig.1 Overall composition of floating submersible

其中，浮游器本體是水下運動設(shè)備和傳感器的搭載平臺。水面支持設(shè)備包括控制箱和便攜式控制器，浮游器本體與水面控制箱通過臍帶電纜連接?？刂葡涮峁└∮纹鞅倔w動力和控制指令；便攜式控制器提供移動式操作，方便操作人員就地觀察并操作浮游器。控制箱及便攜式控制器均帶監(jiān)視器，浮游器本體從水下獲得的視頻圖像和各種參數(shù)在監(jiān)視器上疊加顯示。臍帶絞車的滾筒固定在絞車底盤后部，絞車底盤前部安放浮游器。臍帶電纜可通過手動轉(zhuǎn)動滾筒收放臍帶纜，滾筒不含滑環(huán)，因此吊放時應(yīng)先將需要的臍帶纜放出，再將甲板臍帶纜上兩端接插件插接在控制箱盒臍帶絞車上的插座上，然后可以上電和布放[8]?；厥諘r同樣先將浮游器吊出水面回收，然后斷電，將甲板臍帶纜兩端與控制箱盒臍帶絞車分離，然后再將臍帶纜盤在滾筒上。

2.2 技術(shù)指標和參數(shù)

控制系統(tǒng)應(yīng)達到的技術(shù)指標和參數(shù)如下：

（1）控制箱。

外形尺寸：

重量：<25KG；

結(jié)構(gòu)：箱式，帶拉桿；

（2）便攜式控制盒。

外形尺寸：

重量：<5KG；

結(jié)構(gòu)：箱式；

（3）絞車。

外形尺寸：

重量（含臍帶電纜）：<25Kg；

結(jié)構(gòu)：帶滾輪，便于移動；

（4）最大進退速度：12m/min；

（5）攝像：水平分辨率(彩色/黑白):480/570線；

（6）推進力：前進方向推力≥1.5KG；垂直方向推力：≥1.5KG；

（7）云臺俯仰角度：-90°～+90°；

（8）臍帶纜：50m；

（9)系統(tǒng)便與清洗、去污，外部結(jié)構(gòu)盡量平滑；水下照明和攝像頭有保護裝置，避免與容器的碰撞，避免燈罩玻璃碎片的脫落；

（10）便于安裝、起吊，即投放和回收，包括故障等緊急情況下的起吊和回收；

（11）水下使用電壓≤36V。

3 系統(tǒng)硬件設(shè)計

3.1 浮游器本體設(shè)計

浮游器本體即系統(tǒng)所有水下執(zhí)行機構(gòu)，為了保證可靠性，采用水面采集、控制和驅(qū)動的控制方式，驅(qū)動方式均為一對一[9-10]。浮游器本體上包括的執(zhí)行機構(gòu)有個推進器、直流伺服電機、機械手關(guān)節(jié)電機、直流防爆電機、云臺電機、直流電機、和攝像機調(diào)焦電機。其中，浮游器本體上包括的傳感器有HMR3000羅盤與姿態(tài)傳感器、深度傳感器、漏水檢測探針，對于主要的水下傳感器，也將其信號直接回傳后再進行采樣。

對浮游器本體，控制系統(tǒng)提供3種控制模式：手動、自動（正常模式）、應(yīng)急。手動和自動控制模式下，操作人員通過控制處理器進行浮游器控制，在應(yīng)急狀態(tài)下，允許切斷控制處理器，由操作人員直接控制水下電機。

3.2 水面支持設(shè)備設(shè)計

水面支持設(shè)備包括控制箱、便攜式控制器和臍帶絞車。其中便攜式控制器可以與控制箱分離，在10m范圍內(nèi)活動。

控制箱是浮游器控制中心，所有的輸入、輸出、計算、控制及驅(qū)動都是控制箱發(fā)出的。具有功能如下：電源輸入、臍帶電纜輸出、水面攝像機輸入、自動/手動控制模式切換、推進器應(yīng)急控制、運動自動控制、用于水下數(shù)據(jù)顯示的視頻顯示器和綜合顯控系統(tǒng)，其中綜合顯控系統(tǒng)包括電源、主控計算機和控制電路、視頻字符疊加器，實現(xiàn)的功能包括：（1）浮游器操縱控制指令生成和下行發(fā)送；（2）自動控制規(guī)律的計算：基于PID的自動定向、定深功能，以及推力分配功能；（3）浮游器視頻數(shù)據(jù)合成與顯示。來自水下攝像機的視頻被送往顯示器顯示，通過視頻字符疊加，在顯示器上同時顯示浮游器狀態(tài)信息如深度、首向、縱橫傾、操縱狀態(tài)、時間、客戶字符等。

便攜式控制器是為方便操作人員在水池旁觀察操作使用，具有體積小，重量輕和操作方便等特點，具有信號指示燈、云臺俯仰控制、機械手伸縮控制、機械手卡抓控制、光強度控制、運動手動控制、垂直控制旋鈕和運動自動控制等功能。

4 浮游探測器控制系統(tǒng)

4.1 控制原理及電控系統(tǒng)組成

水下浮游式遙控探測器的電控系統(tǒng)用于實現(xiàn)整個系統(tǒng)的能量分配、設(shè)備控制、航行控制和狀態(tài)監(jiān)測功能。水下浮游探測器控制系統(tǒng)主要包塊三部分：便攜式控制盒、控制箱和浮游式潛水器本體，原理圖如圖2所示。控便攜式控制器、漏水與絕緣在線檢測及推進器驅(qū)動器與控制箱都是通過串口相連接的，制箱內(nèi)主控計算機模塊是多串口計算機，主控計算機有豐富接口，傳感器及操作信息直接與其相連，省去了很多外圍電路，簡潔了電路，減小了系統(tǒng)體積，使得控制箱小型化成為可能?，F(xiàn)場控制計算機和本地控制計算機具有同樣的操作功能，通過本地控制計算機對現(xiàn)場控制計算機進行通訊實現(xiàn)遠程控制，如帶燈按鍵、撥動開關(guān)、操縱桿、電位器等控制操作?，F(xiàn)場控制計算機通過接口電路可實現(xiàn)視頻監(jiān)控相機調(diào)焦電機的運行、漏水報警、羅盤和深度計的反饋，通過調(diào)光器實現(xiàn)雙水下燈供電和控制，通過驅(qū)動器實現(xiàn)4個推進器、機械手和云臺的操縱。

圖2 控制原理Fig.2 Control principle

電控系統(tǒng)由基本航行控制系統(tǒng)、應(yīng)急航行控制系統(tǒng)、手臂手爪控制系統(tǒng)、視頻監(jiān)控系統(tǒng)、照明控制系統(tǒng)、云臺控制系統(tǒng)、漏水與絕緣檢測系統(tǒng)、電源系統(tǒng)等8個系統(tǒng)組成。考慮到輻照環(huán)境下的可靠性，水下系統(tǒng)非常簡單，主要的功能都被集中到水面實現(xiàn)，因為基本航行控制系統(tǒng)和應(yīng)急航行控制系統(tǒng)與電控系統(tǒng)的核心內(nèi)容。

4.2 基本航行控制系統(tǒng)

基本航行控制系統(tǒng)包括450智能控制板、推進器驅(qū)動器及對應(yīng)4臺推進器、傳感器信號采集模塊、控制面板信號采集模塊。這些模塊通過RS485總線組成局部網(wǎng)絡(luò)，共同實現(xiàn)浮游器的運動控制，與基本航行控制系統(tǒng)對應(yīng)的控制面板控件為：自動控制控件、手動控制控件。

4.3 應(yīng)急航行控制系統(tǒng)

除了基本航行控制系統(tǒng)以外，浮游器還配置了1套應(yīng)急航行控制系統(tǒng)，用于4路獨立雙刀常開觸點繼電器控制，實現(xiàn)常規(guī)/應(yīng)急切換隔離與非智能I/0控制。

5 系統(tǒng)軟件設(shè)計

為了使控制軟件中的各模塊相互協(xié)調(diào)穩(wěn)定的工作，讓系統(tǒng)智能控制板的時序資源得到充分的使用，必須對軟件結(jié)構(gòu)與時序進行考慮和良好的設(shè)計。

主控器的軟件結(jié)構(gòu)如圖3所示。與硬件電路模塊相對應(yīng)，系統(tǒng)軟件的模塊劃分為：

圖3 主控制器軟件結(jié)構(gòu)圖Fig.3 Software structure diagram of main controller

（1）主模塊：軟件入口和綜合管理。

（2）顯示模塊：參數(shù)視頻顯示管理。

（3）姿態(tài)傳感器信息處理模塊：HMR3300信息采集與預(yù)處理。

（4）遠程通訊模塊：遠程便攜控制單元與本地控制單元的數(shù)據(jù)通訊。

（5）絕緣漏水通訊模塊：絕緣漏水板與本地之間的數(shù)據(jù)通訊。

（6）I/O口信息采集模塊：控制面板和傳感器信息采集與預(yù)處理。

（7）定時器模塊：實時時序控制。

（8）推進器控制模塊：推力控制指令生成。

（9）部件控制模塊：機械手臂、手爪、云臺、攝像頭等部件的控制指令生成。

在實時控制模塊中，定義了三個時鐘，時鐘1（系統(tǒng)時鐘，0.1ms）：通過調(diào)用I/O信息采集模塊實現(xiàn)控制面板數(shù)據(jù)的采集及傳感器信號的預(yù)處理任務(wù)，通過調(diào)用部件控制模塊，生成各部件的控制指令；時鐘2（50ms）：通過調(diào)用推進控制模塊，完成推力指令生成任務(wù)；時鐘3（200ms）：調(diào)用顯示模塊，通過串口USART2，在發(fā)送中斷中發(fā)送視頻疊加信息，通過串口USART3，在發(fā)送中斷中，發(fā)送呼叫數(shù)據(jù)至絕緣漏水板。姿態(tài)傳感器模塊是使用ARM控制器中的接收中斷，當串口USART1有接收到由電磁羅盤發(fā)送過來的當前的水下機器人姿態(tài)信息時，便發(fā)生中斷，處理接收數(shù)據(jù)。遠程通訊模塊是使用ARM控制器中的中斷，當串口USART6接收到遠程控制單元發(fā)送的控制數(shù)據(jù)時，在接收中斷中處理接收數(shù)據(jù)；收到遠程控制單元的呼叫后，在發(fā)送中斷中發(fā)送絕緣漏水數(shù)據(jù)至遠程控制單元。絕緣漏水通訊模塊使用ARM控制器的中斷，通過串口USART3，在發(fā)送中斷中，發(fā)送呼叫數(shù)據(jù)至絕緣漏水板；在接收中斷中處理收到的絕緣漏水數(shù)據(jù)。I/O口信息采集模塊，通過使用ARM芯片的DI及AI，完成各數(shù)字量及模擬量的采集及預(yù)處理。

6 現(xiàn)場測試

為驗證水下浮游探測器的主要功能和穩(wěn)定性，本文對浮游探測器的自動定深功能與定向性能進行了測試。

6.1 自動定深功能測試

水下浮游探測器系統(tǒng)深度的測量誤差為±0.1m，測試時通過給定一任意目標深度，根據(jù)軟件界面顯示數(shù)據(jù)，來觀察定深效果，再改變水下浮游探測器目標深度值，保存水下浮游探測器的目標深度和實際深度數(shù)據(jù)，畫出定深曲線如圖4和圖5所示：

圖4 定深圖1Fig.4 Depth determination drawing 1

圖5 定深圖2Fig.5 Depth determination drawing 2

觀察結(jié)果如下：目標深度1.1m、顯示深度1.15m、深度顯示數(shù)據(jù)變動范圍為1.00～1.23m。由上面兩個圖可以看出，水下浮游探測器具有良好的定深特性。

6.2 自動定向功能測試

自動定向功能測試是通過改變水下浮游探測器目標首向角，保存水下浮游探測器的目標首向和實際首向數(shù)據(jù)，畫出定向曲線進行，定向曲線如圖6所示。

圖6 定向曲線Fig.6 Orientation curve

根據(jù)實測效果可知，水下浮游探測器具有較好的動態(tài)首向穩(wěn)定性，而靜態(tài)首向穩(wěn)定性仍需改善。

7 結(jié)語

本文在現(xiàn)有水下浮游探測系統(tǒng)的基礎(chǔ)上，總結(jié)經(jīng)驗，分析原有設(shè)計缺陷，對現(xiàn)有水下浮游探測器系統(tǒng)進行改進，通過研究與開發(fā)，最終形成一套水下浮游探測器系統(tǒng)，該系統(tǒng)能夠自由定深、運行平穩(wěn)，攜帶攝像系統(tǒng)，監(jiān)視、監(jiān)測和記錄余熱排出熱交換器水箱目視檢查全過程，自帶照明，滿足本身攝像及作業(yè)所需要的光照強度，并能執(zhí)行異物拾取等任務(wù)，能夠滿足余熱排出熱交換器水箱目視檢查的要求。水下浮游探測器系統(tǒng)的研制與開發(fā)，是核輻射環(huán)境下水下監(jiān)控機器人開發(fā)的一次有效嘗試，可以勝任多種作業(yè)任務(wù)，如核電站堆內(nèi)構(gòu)件檢查、核電站堆內(nèi)構(gòu)件維修與更換的監(jiān)控、核電站主管道內(nèi)部目視檢查、核電站換料水池及乏燃料水池的目視檢查及異物拾取等，同時該系統(tǒng)還可以應(yīng)用于其他非核領(lǐng)域相關(guān)設(shè)備的水下目視檢查及水下異物拾取，其應(yīng)用前景非常廣泛。