申傳俊 肖翼洋 丁澤民 張士成
(1.海軍湛江航保修理廠 湛江 524002)(2.海軍航空大學(xué)青島校區(qū) 青島 264001)(3.海軍工程大學(xué)動(dòng)力工程學(xué)院 武漢 430033)(4.陸軍軍事交通學(xué)院鎮(zhèn)江校區(qū) 鎮(zhèn)江 212003)
模型潛艇的自動(dòng)操縱控制能夠?yàn)槟P蜐撏逻\(yùn)動(dòng)規(guī)律探索[1],粘性流場(chǎng)計(jì)算與阻力分析[2],航行水動(dòng)力特性研究[3],水動(dòng)力參數(shù)辨識(shí)[4],操控系統(tǒng)[5]性能的驗(yàn)證提供方便。實(shí)際模型潛艇有相當(dāng)比例的控制方式為有線控制,給控制帶來(lái)一定的弊端,一定程度限制了模型潛艇的機(jī)動(dòng)。遙控式模型潛艇操控系統(tǒng)則可以克服上述限制,從而能夠較好的模擬潛艇的水下運(yùn)動(dòng)。
本文致力于解決遙控式模型潛艇操控所面臨的技術(shù)難題,設(shè)計(jì)制作集中控制方式的遙控式模型潛艇操控系統(tǒng)。該系統(tǒng)由遙控器以手柄或者鍵盤(pán)輸入方式發(fā)出遙控信號(hào),通過(guò)WIFI無(wú)線通信方式[6]傳輸信號(hào),主控制器收到控制信號(hào)后,自動(dòng)解算,發(fā)出相應(yīng)的操控信號(hào),經(jīng)模擬放大電路放大后,輸入驅(qū)動(dòng)電路,控制執(zhí)行機(jī)構(gòu),進(jìn)行相應(yīng)的注水、排水及轉(zhuǎn)舵,進(jìn)行浮力調(diào)整,縱傾均衡控制,控制主推進(jìn)器轉(zhuǎn)速,使模型潛艇自動(dòng)上浮或者下潛,機(jī)動(dòng)到指定的深度和航向,并能穩(wěn)定于指定的姿態(tài)。
模型潛艇自動(dòng)操控系統(tǒng)的主控制系統(tǒng)組成如圖1所示。
圖1 主控制系統(tǒng)組成框圖
該控制系統(tǒng)由以32位微處理器STM32F103[6]為核心的主控制器、傾角傳感器、深度傳感器、流量計(jì)、模放電路、驅(qū)動(dòng)電路、信號(hào)取樣電路、舵角反饋機(jī)構(gòu)、舵機(jī)執(zhí)行機(jī)構(gòu)、電源系統(tǒng)、高壓氣源系統(tǒng)、壓載水艙系統(tǒng)、浮力調(diào)整系統(tǒng)(圖1中浮力水艙包含壓載水艙與浮力調(diào)整水艙)、縱傾均衡系統(tǒng)、推進(jìn)系統(tǒng)和報(bào)警系統(tǒng)等共同構(gòu)成。其中,浮力調(diào)整系統(tǒng)由浮力調(diào)整水艙、氣源系統(tǒng)、驅(qū)動(dòng)電路、閥件、流量計(jì)等共同構(gòu)成;縱傾均衡系統(tǒng)由均衡電路、比例閥、流量計(jì)和縱傾均衡水艙等共同構(gòu)成。
遙控系統(tǒng)由以增強(qiáng)型單片機(jī)STC12C5A60S2為核心的遙控器主板和WIFI通信模塊、電源系統(tǒng)、顯示器、鍵盤(pán)、操控手柄及無(wú)線路由器等共同構(gòu)成。
關(guān)于潛艇的航向控制,有經(jīng)典的PID控制方法[7]以及模糊控制[8]等方法。本模型潛艇的航向由方向舵進(jìn)行控制,采用PID控制方式,即輸入指令為給定航向θ0,按照偏航角θ,偏航角速率信號(hào)dθdt,偏航角積分信號(hào)∫θd t的控制規(guī)律來(lái)進(jìn)行舵角控制,即方向舵偏舵角α1與偏航角θ符合下列規(guī)律[7,9]:
式(1)中,Kθ,Kd,Ki分別為比例、微分、積分系數(shù)。
模型潛艇的深度由模型潛艇尾部的升降舵進(jìn)行控制[10],采用PD控制方式,即輸入指令為給定深度H0,將當(dāng)前深度差H,深度速率信號(hào)dH dt,縱傾信號(hào)φ,縱傾速率信號(hào)dφdt進(jìn)行綜合,輸入放大電路放大,再輸入功放電路后輸出,控制相應(yīng)的閥件,從而進(jìn)行升降舵舵角控制,達(dá)到控制模型潛艇深度的目的。
升降舵偏舵角α2與深度差 H,深度微分dH dt,縱傾角φ,縱傾角微分dφ dt符合下列規(guī)律[11]:
式(2)中,Kh、Kd,分別為深度差比例和微分系數(shù),Kz、Kdz分別為縱傾角比例和微分系數(shù)。
模型潛艇浮于水面或在水中時(shí)遵循阿基米德定律,即模型潛艇受到的浮力與其排開(kāi)水的重力相等[12]。
當(dāng)模型潛艇需要下潛時(shí),由主控制器控制注水閥和通氣閥,向壓載水艙注水(此時(shí)壓載水艙內(nèi)壓力平衡,水被注入,而空氣經(jīng)通氣閥被排出),模型潛艇質(zhì)量增加,所受重力大于浮力,模型潛艇將由水面狀態(tài)過(guò)渡到水下?tīng)顟B(tài)。
當(dāng)模型潛艇需要上浮時(shí),由主控制器控制氣閥開(kāi)啟,利用高壓氣體吹除壓載水艙的水,造成浮力大于模型潛艇的重力,模型潛艇逐步由水下上浮到水面。
浮力調(diào)整[12],當(dāng)模型潛艇到達(dá)水下后,由于環(huán)境的變化,當(dāng)模型潛艇所受的浮力大于重力時(shí),由主控制器自動(dòng)解算,給出注水量指令,經(jīng)放大電路放大后驅(qū)動(dòng)電磁閥,控制浮力調(diào)整水艙注水,減少浮力,使得所受重力與浮力平衡;當(dāng)模型潛艇受的浮力小于重力時(shí),由主控制器自動(dòng)解算,給出排水量指令,經(jīng)放大電路放大后驅(qū)動(dòng)電動(dòng)氣閥,吹除浮力調(diào)整水艙存量水,增加浮力,使得所受重力與浮力平衡。浮力調(diào)整使得模型潛艇所受浮力與重力平衡,可以保證模型潛艇在某一深度范圍內(nèi)的潛浮狀態(tài)。
縱傾均衡[12],當(dāng)模型潛艇因?yàn)榄h(huán)境改變,自身載荷發(fā)生變化,水下縱傾平衡被破壞后,需要人工或者利用計(jì)算機(jī)進(jìn)行調(diào)整,該過(guò)程即為縱傾均衡。當(dāng)縱傾發(fā)生變化后,由主控制器自動(dòng)解算,給出移水量指令,經(jīng)放大電路放大后驅(qū)動(dòng)電液比例閥,控制設(shè)置于模型潛艇首尾的縱傾均衡水艙1、2之間的移水量,流量計(jì)計(jì)量移水量,從而控制模型潛艇的縱傾。
處于水下縱傾狀態(tài)的模型潛艇,其平衡方程為
式(3)中,W↓為水下所受重力,?↓為水下?tīng)顟B(tài)的模型潛艇水密艇體的排水體積,xG、yG、zG分別為水下?tīng)顟B(tài)時(shí)模型潛艇重心G的縱坐標(biāo)、橫坐標(biāo)和垂向坐標(biāo),xB、yB、zB分別為水下?tīng)顟B(tài)時(shí)模型潛艇浮心B的縱坐標(biāo)、橫坐標(biāo)和垂向坐標(biāo),θ為模型潛艇水下?tīng)顟B(tài)的縱傾角,↓表示水下?tīng)顟B(tài)。
主推進(jìn)系統(tǒng)與側(cè)推進(jìn)系統(tǒng)均由直流無(wú)刷電機(jī)和傳動(dòng)軸及螺旋槳共同構(gòu)成(側(cè)推系統(tǒng)的電機(jī)功率小于主推電機(jī)功率),直流無(wú)刷電機(jī)的控制調(diào)速由ARM發(fā)出PWM信號(hào),經(jīng)過(guò)驅(qū)動(dòng)放大電路放大后,從而實(shí)現(xiàn)對(duì)直流電動(dòng)機(jī)調(diào)速控制。利用H橋式驅(qū)動(dòng)電路作為直流電機(jī)正反轉(zhuǎn)調(diào)速功率放大電路的驅(qū)動(dòng)模塊,采用霍爾傳感器對(duì)直流電機(jī)的轉(zhuǎn)速進(jìn)行測(cè)量,經(jīng)放大電路后,將脈沖信號(hào)送入ARM,從而實(shí)現(xiàn)對(duì)推進(jìn)直流無(wú)刷電機(jī)的轉(zhuǎn)速測(cè)量。
遙控器利用WIFI無(wú)線通信網(wǎng)絡(luò)實(shí)現(xiàn)模型艇的遙控,即遙控器主板將控制信號(hào)輸入WIFI控制芯片,編碼后輸入無(wú)線路由器,無(wú)線路由器發(fā)射信號(hào),模型艇內(nèi)置路由器接收信號(hào),WIFI控制芯片進(jìn)行解碼,輸入主控制器,模型艇將運(yùn)算所得控制信號(hào)實(shí)時(shí)傳遞給WIFI控制芯片,編碼后由無(wú)線路由器發(fā)送給遙控器,遙控器無(wú)線路由接收信號(hào),WIFI控制芯片進(jìn)行解碼,輸入遙控器單片機(jī),由液晶顯示器進(jìn)行顯示。
遙控器開(kāi)機(jī),發(fā)出遙控信號(hào),控制主控制器開(kāi)機(jī),主控制器開(kāi)機(jī)后啟動(dòng)系統(tǒng)。系統(tǒng)自檢通過(guò)后,將模型潛艇當(dāng)前航向、深度、縱傾角、舵角、浮力不均衡量、氣體氣壓、壓載水艙水量、浮力調(diào)整水艙水量、蓄電池電壓與剩余電容量等信息實(shí)時(shí)發(fā)送到遙控器,等待遙控器發(fā)出指令信號(hào)。當(dāng)接收到指令信號(hào)后,主控制器自動(dòng)解算,給出相應(yīng)的注水、排水信號(hào)、操舵角信號(hào)、浮力調(diào)整、縱傾均衡調(diào)整信號(hào),輸入相應(yīng)的放大及驅(qū)動(dòng)電路,進(jìn)行注水、排水、操舵與浮力調(diào)整及縱傾均衡,并操縱主推進(jìn)裝置配合操舵動(dòng)作進(jìn)行模型潛艇機(jī)動(dòng),使模型潛艇運(yùn)動(dòng)到達(dá)指令航向、深度、指令縱傾角,并保持指定的深度與姿態(tài)。
操舵與均衡系統(tǒng)的主控制器核心電路如圖2所示,控制系統(tǒng)的各部分組成及實(shí)現(xiàn)方式分別介紹如下:
·主控制器:以STM32F103RCT6為核心,STM32F103RCT6為意法半導(dǎo)體公司生產(chǎn)的32位微處理器,屬于增強(qiáng)型ARM,內(nèi)含Cortex-M3內(nèi)核,其功能強(qiáng)大,實(shí)時(shí)性較好,I/O接口豐富,含有A/D,D/A電路,PWM以及多個(gè)定時(shí)器,讀寫(xiě)速度快,功耗較低。
·傳感器:包括舵角反饋電機(jī)、深度傳感器、傾角傳感器、液體流量計(jì)、氣壓傳感器、主推進(jìn)電機(jī)和側(cè)推進(jìn)電機(jī)轉(zhuǎn)速傳感器等。
·模擬放大電路:模擬放大電路前級(jí)先將各微弱的指令信號(hào)(-5V~+5V)進(jìn)行電壓放大后送入下一級(jí)功放電路,功放電路的輸出可以驅(qū)動(dòng)電磁閥、電液閥、通氣閥、電動(dòng)氣閥、繼電器和執(zhí)行電機(jī)等。
·舵機(jī)執(zhí)行機(jī)構(gòu):執(zhí)行機(jī)構(gòu)由主控制器發(fā)出控制信號(hào),經(jīng)過(guò)放大器放大后驅(qū)動(dòng)繼電器,控制直流電機(jī)拖動(dòng)舵葉軸轉(zhuǎn)舵。
圖2 主控制系統(tǒng)核心電路原理圖
·舵角反饋機(jī)構(gòu):方向舵和升降舵反饋機(jī)構(gòu)完全相同,包括減速齒輪和連桿等機(jī)械結(jié)構(gòu)及反饋電機(jī)。連桿將舵葉軸向運(yùn)動(dòng)經(jīng)齒輪傳遞到反饋電機(jī),反饋電機(jī)將舵角轉(zhuǎn)化為電壓信號(hào),經(jīng)電纜傳輸?shù)饺与娐?,最終送入主控制器。
·舵角電氣限位裝置:舵機(jī)控制線路安裝有舵角電氣限位裝置,當(dāng)舵角接近滿舵時(shí),進(jìn)行自動(dòng)限位,防止發(fā)生舵葉轉(zhuǎn)動(dòng)失控。
·信號(hào)取樣電路:取樣電路將輸入的信號(hào)進(jìn)行取樣后,保持,送入主控制器。
·縱傾均衡系統(tǒng):包括縱傾均衡水艙、電液閥、流量計(jì)、傾角傳感器等。主控制器控制模放電路,驅(qū)動(dòng)電液閥,控制設(shè)置于艇首和艇尾的縱傾均衡水艙之間的移水量,從而控制模型潛艇的縱傾。
浮力控制系統(tǒng)包括壓載水艙系統(tǒng)和浮力調(diào)整系統(tǒng)。
·壓載水艙系統(tǒng):包括壓載水艙、高壓氣瓶、電磁閥、氣閥、液體流量計(jì)、模擬放大電路等。
主控制器控制模放電路從而驅(qū)動(dòng)電磁閥與通氣閥,進(jìn)而控制壓載水艙的注水量(由流量計(jì)計(jì)量),使模型潛艇質(zhì)量增加,所受正浮力減少,模型潛艇由水面狀態(tài)過(guò)渡到水下?tīng)顟B(tài)。主控制器控制模放電路從而控制氣閥,利用高壓氣體吹除壓載水艙內(nèi)的水,使模型潛艇質(zhì)量減少,所受正浮力增加,模型潛艇由水下?tīng)顟B(tài)過(guò)渡到水上狀態(tài)。
·浮力調(diào)整系統(tǒng):包括浮力調(diào)整水艙、高壓氣瓶、電液比例閥、氣閥、液體流量計(jì)、模擬放大電路等。
主控制器控制模放電路,驅(qū)動(dòng)電液比例閥,從而控制浮力調(diào)整水艙注水量(由流量計(jì)計(jì)量),從而減少浮力;主控制器控制模放電路,驅(qū)動(dòng)氣閥,吹除浮力調(diào)整水艙的水(由流量計(jì)計(jì)量),從而增加浮力。
推進(jìn)電機(jī)采用直流無(wú)刷電機(jī)[13],調(diào)速控制系統(tǒng)原理如圖3所示。
圖3 推進(jìn)系統(tǒng)調(diào)速控制原理框圖
控制系統(tǒng)包括:光電隔離電路、電機(jī)驅(qū)動(dòng)邏輯電路、驅(qū)動(dòng)信號(hào)放大電路、電荷放大電路、H橋功率驅(qū)動(dòng)電路等四部分。其主要控制信號(hào)有:電機(jī)運(yùn)轉(zhuǎn)方向信號(hào)Dir、電機(jī)調(diào)速信號(hào)PWM、電機(jī)制動(dòng)信號(hào)Brake,Vcc為驅(qū)動(dòng)邏輯電路部分提供電源,Vm為電機(jī)電源電壓。
遙控器主板以單片機(jī)STC12C5A60S2為核心,輔以輸入鍵盤(pán)和操控手柄,顯示電路(128*64液晶顯示器),電源電路(穩(wěn)壓電路和6V電池)等共同構(gòu)成。
通信電路由通信芯片ESP8266和無(wú)線路由器(功率增強(qiáng)型)等共同構(gòu)成,遙控器發(fā)出的指令信號(hào)經(jīng)ESP編碼后輸入無(wú)線路由器,信號(hào)發(fā)射后,被模型潛艇的無(wú)線路由器接收,ESP解碼后輸入模型潛艇主控制器,主控制器獲取的相應(yīng)參數(shù),經(jīng)ESP編碼后由路由器發(fā)送給遙控器。
·電源系統(tǒng):主控制系統(tǒng)的電源系統(tǒng)由60V蓄電池、電源穩(wěn)壓電路(輸出+3.3V,+5V,±12V,+24V,+48V)、保護(hù)電路、狀態(tài)指示電路共同構(gòu)成,向主控制器、模擬放大電路、功率放大電路、舵機(jī)執(zhí)行機(jī)構(gòu)、壓載水艙系統(tǒng)、均衡系統(tǒng)、報(bào)警系統(tǒng)、浮力調(diào)整系統(tǒng)、主推進(jìn)系統(tǒng)與側(cè)推進(jìn)系統(tǒng)(均使用48V推進(jìn)電機(jī))等供電。遙控器由干電池供電,經(jīng)穩(wěn)壓后供電路使用。
·報(bào)警系統(tǒng):由觸發(fā)電路、報(bào)警指示燈、蜂鳴器等共同構(gòu)成,對(duì)超深、危險(xiǎn)縱傾、卡舵、電動(dòng)舵機(jī)過(guò)載、主推進(jìn)電機(jī)過(guò)載、電池電壓低等信號(hào)進(jìn)行報(bào)警。
操控系統(tǒng)軟件分為遙控器系統(tǒng)軟件和主控制器系統(tǒng)軟件。
遙控器,其核心為STC12C5A60S2單片機(jī),其系統(tǒng)軟件采用Keil C51環(huán)境開(kāi)發(fā),利用C語(yǔ)言實(shí)現(xiàn)。該系統(tǒng)軟件采用模塊化結(jié)構(gòu),分為通訊、信號(hào)處理、信號(hào)發(fā)送、信息顯示幾個(gè)任務(wù)子程序。
主控制器,其核心為微控制器STM32F103RCT6,其系統(tǒng)軟件采用MDK5開(kāi)發(fā)環(huán)境,利用C語(yǔ)言實(shí)現(xiàn)。軟件采用模塊化結(jié)構(gòu),分為通訊、自檢、信號(hào)采集與處理、信號(hào)發(fā)送、危險(xiǎn)狀態(tài)處置與報(bào)警等幾個(gè)任務(wù)子程序。主控制器要實(shí)施模型潛艇航向、深度的自動(dòng)控制及危險(xiǎn)狀態(tài)的應(yīng)急處置,其系統(tǒng)需要響應(yīng)事件中斷,因此,需要事先設(shè)置中斷優(yōu)先級(jí)別。主控系統(tǒng)的中斷事件主要有:電池電壓低、危險(xiǎn)深度、危險(xiǎn)縱傾、舵機(jī)過(guò)載、電機(jī)超速、卡舵、氣瓶氣壓低等。在上述中斷事件中,設(shè)定中斷優(yōu)先級(jí)為:電池電壓低>氣瓶氣壓低>主推進(jìn)電機(jī)過(guò)載>升降舵電動(dòng)舵機(jī)過(guò)載>升降舵卡舵>主推進(jìn)電機(jī)超速>方向舵電動(dòng)舵機(jī)過(guò)載>側(cè)推進(jìn)電機(jī)過(guò)載>危險(xiǎn)深度>危險(xiǎn)縱傾>方向舵卡舵。
設(shè)計(jì)了一種模型潛艇自動(dòng)操控系統(tǒng),其主控制器和遙控器分別以STM32F103RCT6和STC12C5A60S2為核心,結(jié)合傳感器、主推進(jìn)系統(tǒng)、舵機(jī)執(zhí)行機(jī)構(gòu)、反饋機(jī)構(gòu)、縱傾均衡系統(tǒng)、壓載水艙系統(tǒng)、浮力調(diào)整系統(tǒng)、電源系統(tǒng)、報(bào)警系統(tǒng)等共同構(gòu)成自動(dòng)操控系統(tǒng)。經(jīng)過(guò)在航模池進(jìn)行實(shí)際航行試驗(yàn),該模型潛艇能夠在150m范圍內(nèi)進(jìn)行遙控,最大下潛深度1.5m,能夠有效地控制上浮、下潛與機(jī)動(dòng),并能穩(wěn)定于給定的航向、深度與姿態(tài),主推進(jìn)裝置正車(chē)、倒車(chē)功能正常,側(cè)推進(jìn)裝置功能正常,系統(tǒng)報(bào)警功能正常。航模池試航試驗(yàn)結(jié)果表明,該模型潛艇自動(dòng)操控系統(tǒng)操控性能達(dá)到預(yù)期的設(shè)計(jì)目標(biāo)。
[1]李麓,李維嘉.潛艇水下六自由度運(yùn)動(dòng)仿真數(shù)學(xué)模型[J].計(jì)算機(jī)仿真,2001,18(5):33-38.
[2]邱遼原.潛艇粘性流場(chǎng)的數(shù)值模擬及其阻力預(yù)報(bào)的方法研究[D].武漢:華中科技大學(xué),2006:84-100.
[3]王燕飛,朱軍,張振山.評(píng)估水動(dòng)力系數(shù)對(duì)潛艇操縱性影響的一種方法[J].船舶力學(xué),2005,9(5):61-68.
[4]朱怡.水下潛器水動(dòng)力模型簡(jiǎn)化及參數(shù)辨識(shí)研究[D].哈爾濱:哈爾濱工程大學(xué),2007:32-42.
[5]李光磊,周永余,陳永冰,等.基于潛艇自動(dòng)操縱系統(tǒng)的模型簡(jiǎn)化及仿真[J].船電技術(shù),2009,29(7):19-23.
[6]楊鄭民,徐軼群.基于WIFI和STM32船舶制造業(yè)智能配電樁系統(tǒng)設(shè)計(jì)[J].電子技術(shù)應(yīng)用,2016,42(10):69-72.
[7]周永余.艦艇自動(dòng)操舵儀[M].武漢:海軍工程大學(xué),2004:12-15.
[8]熊瑛.基于智能控制的潛艇操縱運(yùn)動(dòng)仿真研究[D].武漢:中國(guó)艦船研究院,2011:63-75.
[9]陳小靜.無(wú)人潛航器的自動(dòng)航行系統(tǒng)研究[D].大連:大連海事大學(xué),2008:21-22.
[10]孫元良,馬運(yùn)義,鄧志純.潛艇和深潛器的現(xiàn)代操縱理論與應(yīng)用[M].北京:國(guó)防工業(yè)出版社,2001:12-30.
[11]何衛(wèi)華,王益民,黃健鷹.潛艇自動(dòng)操 縱控制系統(tǒng)的基本原理及其現(xiàn)狀[J].艦船科學(xué)技術(shù),2005,17(3):20-24.
[12]蘇玉民,龐永杰.潛艇原理[M].哈爾濱:哈爾濱工程大學(xué)出版社,2005:40-46.
[13]鄭宏,張佳偉,徐文成.基于STM32的直流無(wú)刷電機(jī)正弦波控制系統(tǒng)[J].電子器件,2016,39(6):1521-1526.