紅外導(dǎo)引智能航行控制系統(tǒng)設(shè)計與實現(xiàn)

1、    紅外導(dǎo)引智能航行控制系統(tǒng)設(shè)計與實現(xiàn)    溫景松 仲偉波 馮友兵 姚旭洋摘  要： 采用模塊化設(shè)計方案設(shè)計并實現(xiàn)了一種基于紅外信號導(dǎo)引的智能航行控制系統(tǒng)。該系統(tǒng)主要由紅外導(dǎo)引信號采集模塊、船模運動控制模塊及驅(qū)動模塊組成。采用雙向比較分析方法處理接收到的紅外導(dǎo)引信號，快速判定紅外導(dǎo)引信號的方向。采用pid控制策略，通過調(diào)節(jié)脈寬調(diào)制信號的占空比控制船模的航速和航向。實船測試結(jié)果表明，雙向比較分析法能夠快速準(zhǔn)確地判定紅外導(dǎo)引信號方位，船模運動控制穩(wěn)定可靠，高航速下也有較好的導(dǎo)引方向判定和航行控制效果。關(guān)鍵詞： 智能航行; 紅外導(dǎo)引; 模塊化設(shè)

2、計; 雙向比較分析; 信號處理; 航向判定; 實船測試： tn219?34; tp273                    ： a                     ： 1004?373x（2019）20?0112?04design and implementation of intelligent navigation control systemguided by infrared

3、signalwen jingsong， zhong weibo， feng youbing， yao xuyang（school of electronics and information engineering， jiangsu university of science and technology， zhenjiang 212003， china）abstract： an intelligent navigation control system based on infrared signal guidance is designed and implemented by means

4、 of modular design scheme. the system is composed of infrared guidance signal acquisition module， ship model motion control module and driver module. the received infrared guidance signal is processed by means of bidirectional comparative analysis method to quickly judge the azimuth of the infrared

5、guidance signal. the pid control strategy is adopted to control the speed and course of ship model by adjusting the duty ratio of pulse width modulation signal. the actual ship test results show that the bidirectional comparative analysis method can quickly and accurately judge the azimuth of infrar

6、ed guidance signal， make the ship model motion control stable and reliable， and has better guidance direction judgment and navigation control effect at high speed.keywords： intelligent navigation; infrared guidance; modular design; bidirectional comparative analysis; signal processing; course judgme

7、nt; actual ship test0  引  言全國海洋航行器設(shè)計與制作大賽是我國船舶與海洋工程領(lǐng)域內(nèi)最為重要的競賽之一，其中船模智能航行比賽集船模設(shè)計和控制為一體，是大賽的比賽項目之一。船模智能航行比賽中船模自動捕獲并跟蹤紅外導(dǎo)引信號，按照比賽系統(tǒng)給定的路線依次通過導(dǎo)引門，航線上共設(shè)10個引導(dǎo)門，引導(dǎo)門寬1.0 m，高0.4 m，每個引導(dǎo)門最大間距為20 m，賽道總長不超過150 m。引導(dǎo)門上有紅外導(dǎo)引信號，波長940 nm，發(fā)射軸線與水面平行。比賽船模需在10 min內(nèi)按照規(guī)定線路完成比賽則成績有效，用時少者勝1。根據(jù)全國海洋航行器設(shè)計與制作大賽船模智能航行的比賽

8、規(guī)則，本文設(shè)計并實現(xiàn)了一種船模智能航行控制方案：船模采用單槳單舵運動控制方式，根據(jù)紅外引導(dǎo)信號的特點，設(shè)計了紅外引導(dǎo)信號獲取方案和濾波處理方法，能夠準(zhǔn)確捕捉到導(dǎo)引門系統(tǒng)發(fā)出的紅外引導(dǎo)信號，采用pid控制方法對船模的運動進行控制。所設(shè)計的紅外信號導(dǎo)引智能航行控制方案已被多個船模采用，并在多次全國海洋航行器設(shè)計與制作大賽中獲得優(yōu)異成績。根據(jù)全國海洋航行器設(shè)計與制作大賽船模智能航行的比賽規(guī)則及其對動力的要求，選用單體單槳單舵的船體結(jié)構(gòu)和運動控制模式，這種結(jié)構(gòu)具有阻力小、航速快、航向調(diào)節(jié)靈活、反應(yīng)速度快等優(yōu)點。通過對成品船模加裝紅外引導(dǎo)信號采集盤和航行控制系統(tǒng)實現(xiàn)智能航行功能。其中紅外引導(dǎo)信號采集盤高

9、度要適中，既要保證能采集到紅外導(dǎo)引信號，還要保持船體的重心盡量靠下，防止船模在高速轉(zhuǎn)彎時發(fā)生側(cè)翻。1  系統(tǒng)硬件設(shè)計系統(tǒng)硬件是船模智能航行的基礎(chǔ)，包括紅外導(dǎo)引信號采集處理模塊、運動控制模塊和驅(qū)動模塊，整個系統(tǒng)的架構(gòu)如圖1所示。圖1  智能船?？刂葡到y(tǒng)架構(gòu)圖根據(jù)船模智能航行的比賽規(guī)則，整個系統(tǒng)只能使用4節(jié)5號干電池。為了提高船模速度，需采用大功率驅(qū)動電機，但大功率驅(qū)動電機啟動和運行時會導(dǎo)致電源輸出穩(wěn)定性差，從而影響整個系統(tǒng)的穩(wěn)定性。為此采用超級電容來提升系統(tǒng)的電源穩(wěn)定性和可靠性，選用4個100 f/2.7 v超級電容兩兩串聯(lián)后并聯(lián)作為紅外導(dǎo)引檢測和控制系統(tǒng)的電源，4節(jié)5號干電

10、池通過單向二極管給電容充電，在大功率電機驅(qū)動運行時也可以保證系統(tǒng)的電源穩(wěn)定和可靠。根據(jù)船模智能航行比賽的引導(dǎo)信號特點，采用tsop34838紅外一體化接收管作為紅外信號檢測傳感器，如圖2所示。將紅外引導(dǎo)信號接收模塊設(shè)計成圓盤形，圓盤邊緣均勻布置16個紅外信號檢測傳感器，外加黑色屏蔽罩減少噪聲及相鄰方向紅外信號干擾。為了方便調(diào)試與檢測，當(dāng)接收管接收到紅外信號對應(yīng)指示燈亮。紅外引導(dǎo)信號檢測電路實時將檢測結(jié)果交由stc15w單片機進行處理，然后按設(shè)定頻率向運動控制模塊發(fā)送紅外引導(dǎo)信號方向數(shù)據(jù)，運動控制模塊據(jù)此進行控制。圖2  紅外導(dǎo)引信號檢測模塊控制模塊主控芯片為stc15w系列芯片，該芯

11、片接口多、集成度高、工作電壓范圍寬。采用單片機自帶的兩路pwm端口分別控制直流電機和舵機，取代使用定時器產(chǎn)生pwm信號的方法，有效節(jié)省了cpu資源2。驅(qū)動模塊對運動控制模塊輸出的兩路pwm信號進行處理，控制直流電機轉(zhuǎn)速和舵機的轉(zhuǎn)動角度，達到對船模航速和航向的控制。驅(qū)動模塊pwm信號輸入端先采用光耦進行隔離，經(jīng)過nmosfet管放大輸出。上述方案可以有效減少電機工作電路部分對控制電路的影響，從而提高整個系統(tǒng)的穩(wěn)定性和可靠性3?4。2  控制系統(tǒng)軟件設(shè)計軟件部分主要包括紅外引導(dǎo)信號檢測和數(shù)據(jù)處理，從而獲取準(zhǔn)確的引導(dǎo)信號方向，船模運動控制系統(tǒng)根據(jù)引導(dǎo)信號方向和當(dāng)前的航速與航向，采用pid控

12、制方法計算船模槳舵控制電機的工作參數(shù)，并由控制芯片產(chǎn)生對應(yīng)的控制信號輸出至驅(qū)動電路驅(qū)動電機，從而實現(xiàn)船模的運動控制5?7。系統(tǒng)軟件流程圖如圖3所示。根據(jù)規(guī)則，船模智能航行比賽中的紅外引導(dǎo)信號符合nec協(xié)議，即包括9 ms的高電平、4.5 ms的低電平、4個字節(jié)地址碼和命令碼。由此可知紅外引導(dǎo)信號發(fā)射周期約為66 ms，并且一個周期內(nèi)紅外傳感器可以接收到有效信號的時間約為27 ms，約占整個編碼信號周期的40%。為此，系統(tǒng)每隔33 s檢測一次紅外信號，如果端口檢測到紅外信號對此端口計數(shù)值加1，采集200次統(tǒng)計檢測到紅外信號的有效次數(shù)，若紅外信號有效次數(shù)大于60次，則認(rèn)為該方向有紅外引導(dǎo)信號存在。

13、實際中紅外引導(dǎo)信號采集盤會收到來自不同方向的紅外信號，需要通過處理來確定紅外引導(dǎo)信號的方向。本文采用雙向比較分析方法進行信號處理，具體方法如下：首先對接收到的信號進行預(yù)處理，把采集盤正后方傳感器的信號丟掉，余下的15個信號提取出來分別存入2個字節(jié)中，正前方信號作為2個字節(jié)的公用位分別存入字節(jié)1和字節(jié)2中的l0和r0位，每一位分別代表對應(yīng)紅外接收傳感器信號端的狀態(tài)，狀態(tài)1代表接收到紅外信號，狀態(tài)0代表無紅外信號。高位代表最左邊信號和最右邊信號，具體處理流程如圖4所示。通過雙向比較分析方法可以快速判斷信號發(fā)射源的準(zhǔn)確方位，負(fù)度數(shù)代表左偏方位，正度數(shù)代表右偏方位。圖3  控制系統(tǒng)軟件流程圖

14、船模航行過程中由于紅外引導(dǎo)信號漏檢，或者船模駛?cè)胄盘柮^(qū)等原因造成短暫信號丟失，此時系統(tǒng)先保持船模直行，打開定時器監(jiān)測信號丟失時間，當(dāng)信號丟失時間超過設(shè)定時間，系統(tǒng)啟動信號丟失處理策略，即船模立即降速并緩慢轉(zhuǎn)彎并搜尋紅外引導(dǎo)信號。船模在水中的運動規(guī)律比較復(fù)雜，很難用一個精確的數(shù)學(xué)模型描述。pid控制是一種簡單、控制參數(shù)物理意義明確、基于誤差消除誤差策略的控制算法，不依賴被控對象的數(shù)學(xué)模型也能夠得到較好的控制效果，被廣泛應(yīng)用于系統(tǒng)閉環(huán)控制。本文采用pid控制方法對船模航向進行控制，船頭方向和紅外信號發(fā)射源的方向夾角作為pid控制器的偏差e輸入，r（t）為0°，即船頭方向正對紅外發(fā)射源，

15、控制器的輸出為pwm脈寬，通過驅(qū)動模塊控制舵機的偏轉(zhuǎn)角度。航速主要根據(jù)船模的航向設(shè)定，船模航向角越大速度越小，當(dāng)船模正對紅外引導(dǎo)信號方向時速度達到最大8?9。為了方便智能船模的調(diào)試，采用基于nrf24l01的短距離無線數(shù)據(jù)通信模塊，在船模航行過程中通過上位機監(jiān)測船模對紅外信號的檢測和濾波處理情況，為船模參數(shù)的調(diào)試提供參考10。圖5為船模航行過程中某一時刻信號的采集和濾波處理情況，綠色指針代表濾波處理后輸出的方位角。船模改造完成后先進行了各模塊的功能測試，功能測試通過后又在船模智能航行比賽系統(tǒng)中進行了整體測試。測試結(jié)果表明，本文給出的設(shè)計結(jié)果滿足船模智能航行比賽要求。圖5  上位機紅外

16、信號監(jiān)測3  結(jié)  語根據(jù)全國海洋航行器設(shè)計制作大賽艦船智能航行比賽規(guī)則，從船?？刂葡到y(tǒng)的可靠性、穩(wěn)定性、精確性出發(fā)研制了一套軟硬件結(jié)合基于紅外引導(dǎo)的智能航行船模。智能航行船模的關(guān)鍵是紅外引導(dǎo)信號的采集與處理，系統(tǒng)采用雙向比較分析方法有效確保紅外信號方位判斷的正確性。通過上位機在線監(jiān)測控制系統(tǒng)變量信息，經(jīng)過多次試驗對pid參數(shù)進行整定，獲得了較好的航向航速協(xié)同控制效果?；谏鲜鲈O(shè)計方案完成的船模參加了多屆全國海洋航行器設(shè)計與制作大賽智能航行比賽，獲得優(yōu)秀成績，證明了本文給出的設(shè)計方案穩(wěn)定可靠。參考文獻1 中國造船工程學(xué)會.第七屆全國海洋航行器設(shè)計與制作大賽評分細(xì)則eb/ol

17、.2017?04?28.http：/chinese society of naval architecture and marine engineering. the seventh national ocean navigator design and production competition rules eb/ol. 2017?04?28. http：/2 高正中，趙晨暉，宋森森.基于stc15 mcu的微型四軸飛行器設(shè)計j.現(xiàn)代電子技術(shù)，2016，39（24）：145?148.gao zhengzhong， zhao chenhui， song sensen. design of m

18、icro four?axis vehicle based on stc15 mcu j. modern electronics technique， 2016， 39（24）： 145?148.3 胡發(fā)煥，邱小童，蔡咸健.基于場效應(yīng)管的大功率直流電機驅(qū)動電路設(shè)計j.電機與控制應(yīng)用，2011，38（4）：21?24.hu fahuan， qiu xiaotong， cai xianjian. design of high?power driver for dc motor base on mosfet j. motor and control applications， 2011， 38 （4）

19、： 21?24.4 陳柯，李媛媛，方璇.單片機驅(qū)動電機的設(shè)計與實現(xiàn)j.實驗室研究與探索，2016，35（3）：119?122.chen ke， li yuanyuan， fang xuan. design and implementation of driving motor based on mcu j. laboratory research and exploration， 2016， 35（3）： 119?122.5 劉海旗，何軍紅.基于avr單片機的紅外導(dǎo)航無人船的設(shè)計與實現(xiàn)j.工業(yè)儀表與自動化裝置，2015（4）：47?50.liu haiqi， he junhong. desig

20、n and implementation of infrared navigation unmanned ship based on avr j. industrial instrument and automation device， 2015（4）： 47?50.6 朱春華，顧雪亮.基于紅外反射式傳感器tcrt5000的循跡小車設(shè)計j.現(xiàn)代電子技術(shù)，2018，41（18）：143?146.zhu chunhua， gu xueliang. track car design based on infrared reflective sensor tcrt5000 j. modern electronics technique， 2018， 41（18）： 143?146.7 史曉娟，李松博.基于avr單片機的嵌入式可編程控制系統(tǒng)j.儀表技術(shù)與傳感器，2017（6）：54?58.shi xiaojuan， li songbo. embedded programmable control system based on avr mcu j. instrument technology and sensors， 2017（6）： 54?58.8 馬婭婕，彭攀來，劉