基于Wifi的井下機器人通信控制系統(tǒng)的制作方法
【技術(shù)領(lǐng)域】
[0001]本發(fā)明涉及一種基于Wifi的井下機器人通信控制系統(tǒng)，該系統(tǒng)涉及無線通信和視頻、音頻采集等領(lǐng)域。
【背景技術(shù)】
[0002]隨著各類礦井生產(chǎn)的機械化、信息化和自動化程度的提高，中國礦井安全生產(chǎn)形勢逐年好轉(zhuǎn)，各類事故率和死亡率均大幅下降。然而井下生產(chǎn)環(huán)境復(fù)雜，還是不可避免的發(fā)生各類事故，事故發(fā)生后，及時掌握井下事故現(xiàn)場情況，是正確、有效救援，減少人員傷亡的關(guān)鍵。井下瓦斯爆炸和火災(zāi)等事故，會產(chǎn)生大量C0，C02，CH4等有毒有害氣體，消耗大量02。當事故現(xiàn)場有毒有害氣體濃度超高、O2含量較低時、搜尋，救護人員難以到達有關(guān)區(qū)域進行偵察、搜尋和救援。井下機器人除用于救災(zāi)外，也可用于井下巡檢領(lǐng)域。因此、研究井下機器人相關(guān)的技術(shù)十分必要。由于目前井下無線通信的接入設(shè)備需供電系統(tǒng)和通信光纜或電纜連接，所以事故發(fā)生時，巷道內(nèi)原有無線通信系統(tǒng)無法使用，井下機器人必須自帶通信系統(tǒng)進行通信。輪式、履帶式、蛇形等地面行進的機器人可通過有線通信方式與控制設(shè)備進行通信，而采用飛行行進方式的機器人則應(yīng)采用無線通信方式，目前井下Wifi無線通信網(wǎng)絡(luò)已得到較廣泛的應(yīng)用，Wifi無線通信具有數(shù)據(jù)傳輸高度、安全可靠、使用靈活方便等特點，但通信距離受發(fā)射功率和空間阻擋等因素影響，直接影響井下機器人的工作距離。所以需要新的通信組網(wǎng)方式和系統(tǒng)以保證井下機器人的通信距離。

【發(fā)明內(nèi)容】

[0003]本發(fā)明目的在于提供一種基于Wifi的井下機器人通信控制系統(tǒng)，所述系統(tǒng)用于使井下機器人的無線通信距離隨機器人的行進而不斷增長。井下機器人采用Wifi多跳無線網(wǎng)絡(luò)與控制設(shè)備通信，井下機器人攜帶有多個Wifi路由設(shè)備，在行進過程中同時根據(jù)設(shè)定條件投放Wifi無線路由設(shè)備，使Wifi網(wǎng)絡(luò)的覆蓋范圍隨井下機器人的行進路程的增加而不斷推進，以保證井下機器人與機器人控制設(shè)備的通信;所述通信控制系統(tǒng)通過井下機器人攜帶的視頻采集設(shè)備采集視頻或圖像數(shù)據(jù)，將數(shù)據(jù)通過Wifi多跳無線網(wǎng)絡(luò)傳輸至機器人控制設(shè)備;井下機器人攜帶有語音采集元件和語音放大設(shè)備，通過語音采集元件采集語音信號，通過語音放大設(shè)備將通過網(wǎng)絡(luò)下傳的語音數(shù)據(jù)還原為語音信號放大播放。
[0004]所述系統(tǒng)井下機器人攜帶有多個無線路由設(shè)備，鋪設(shè)無線網(wǎng)絡(luò)的方法包括以下3種:
[0005]1.井下機器人在行進過程中監(jiān)測最近的固定Wifi路由設(shè)備信號強度，當信號強度低于設(shè)定閾值時，則井下機器人在當前位置投放新的固定Wifi路由設(shè)備，重復(fù)執(zhí)行以上監(jiān)測與投放過程，使Wifi網(wǎng)絡(luò)的覆蓋范圍隨井下機器人的行進不斷推進。
[0006]2.井下機器人在行進過程中測量并記錄行進的路程長度，當以最近的固定Wifi路由設(shè)備為起點行進的路程長度達到設(shè)定閾值時，則在當前位置投放新的固定Wifi路由設(shè)備，重復(fù)執(zhí)行以上監(jiān)測和投放過程，使Wifi網(wǎng)絡(luò)的覆蓋范圍隨井下機器人的行進路程的增加而不斷推進。
[0007]3.井下機器人在行進過程中監(jiān)測最近的固定Wifi路由設(shè)備信號強度，同時測量以最近的固定無線路由設(shè)備為起點的行進路程長度，當滿足Wifi信號強度低于設(shè)定閾值或行進的路程長度達到設(shè)定閾值時，則在當前位置投放新的固定Wifi路由設(shè)備，重復(fù)執(zhí)行以上監(jiān)測和投放過程，使Wifi網(wǎng)絡(luò)的覆蓋范圍隨井下機器人的行進路程的增加而不斷推進。所述系統(tǒng)還包括以下特點:
[0008]1.井下機器人采用模塊化結(jié)構(gòu)，具有標準通信接口，用于攜帶各類與井下現(xiàn)場環(huán)境監(jiān)測相關(guān)的傳感器模塊，所采集數(shù)據(jù)通過多跳無線網(wǎng)絡(luò)傳輸至控制設(shè)備。
[0009]2.井下機器人攜帶的傳感器包括:溫度、一氧化碳、二氧化碳、甲烷和氧氣傳感器。
[0010]3.機器人控制設(shè)備可部署于井上也可部署于井下，井下機器人可受機器人控制設(shè)備控制從井上出發(fā)移動至井下。
[0011]4.井下機器人包括采用兩軸或多軸旋翼飛行移動的機器人。
【附圖說明】
[0012]圖1系統(tǒng)實施方式I示意圖。
[0013]圖2系統(tǒng)實施方式2示意圖。
[0014]圖3四軸旋翼井下機器人結(jié)構(gòu)示意圖。
[0015]圖4Wifi路由器投放裝置示意圖。
[0016]圖5Wifi路由器投放裝置仰視圖。
[0017]圖6四軸旋翼井下機器人主控板結(jié)構(gòu)示意圖。
[0018]圖7四軸旋翼井下機器人數(shù)據(jù)采集板結(jié)構(gòu)示意圖。
[0019]圖8四軸旋翼井下機器人主控板軟件示意圖。
[0020]圖9Wifi路由投放子系統(tǒng)流程圖
【具體實施方式】
[0021]所述通信控制系統(tǒng)的【具體實施方式】I如圖1所示，組成包括:
[0022]1.機器人控制設(shè)備(101)，負責控制井下機器人，通過多跳Wifi網(wǎng)絡(luò)和以太網(wǎng)接收井下機器人上傳的各類數(shù)據(jù)，包括視頻或圖像數(shù)據(jù)，各類傳感器數(shù)據(jù)、語音數(shù)據(jù)；同時通過以太網(wǎng)和多跳Wifi網(wǎng)絡(luò)向井下機器人發(fā)送控制數(shù)據(jù)和語音數(shù)據(jù)。
[0023]2.井上交換機(102)，負責所有接入以太網(wǎng)的設(shè)備的管理和數(shù)據(jù)交換。
[0024]3.井下交換機(103)，負責井下所有接入以太網(wǎng)的設(shè)備的數(shù)據(jù)交換。
[0025]4.井下機器人(104)，可采用旋翼飛行機器人，也可采用輪式、履帶式、蛇形等地面行進的機器人，攜帶多個Wifi路由設(shè)備(106)，用于在行進中投放布網(wǎng)。
[0026]5.Wifi核心交換機(105)，負責多跳Wifi網(wǎng)絡(luò)的管理，接收和轉(zhuǎn)發(fā)所有Wifi路由設(shè)備的數(shù)據(jù)，具有網(wǎng)絡(luò)接口用于連接井下交換機或井下機器人控制設(shè)備。
[0027]6.Wifi路由設(shè)備(106)，負責Wifi終端設(shè)備的接入和Wifi網(wǎng)絡(luò)接續(xù)，由電池供電，體積小重量輕，便于井下機器人攜帶，處理器采用Atheros AR7161，無線芯片采用AtherosAR9220。
[0028]所述通信控制系統(tǒng)的【具體實施方式】2如圖2所示，與實施方式I的區(qū)別在于機器人控制設(shè)備(101)直接連接Wifi核心交換機(105)，機器人控制設(shè)備可部署于井上也可部署于井下，機器人控制設(shè)備部署于井上時，井下機器人可直接通過斜井、平硐飛行至井下。
[0029]所述通信控制系統(tǒng)中的井下機器人可采用飛行機器人也可采用地面行進機器人，在本示例采用四軸旋翼井下機器人，機器人結(jié)構(gòu)如圖3所示:
[0030]1.旋翼(301),通過旋轉(zhuǎn)使空氣向下運動產(chǎn)生升力，使機器人懸浮在空中。
[0031]2.電機(302)，負責為旋翼提供動力，由控制板控制轉(zhuǎn)速，通過各旋翼不同轉(zhuǎn)速而實現(xiàn)機器人的不同運動方向和姿態(tài)。
[0032]3.傳感器倉(303)用于放置各種類與井下現(xiàn)場環(huán)境監(jiān)測相關(guān)的傳感器模塊。
[0033]4.天線(304)用于無線信號發(fā)送和接收。。
[0034]5.控制板倉(305)內(nèi)置無人機控制板，用于飛行控制、數(shù)據(jù)采集和無線通信等。
[0035]6.電池倉(306)用于電池存放，為旋翼、控制板及各傳感器模塊供電。
[0036]7.麥克風(307)用于語音信號采集，當救援無人機到達井下工作人員被困地點時，可通過麥克風采集被困人員的語音信號，并通過無線網(wǎng)絡(luò)和以太網(wǎng)將語音數(shù)據(jù)傳送至控制設(shè)備。
[0037]8.數(shù)字攝像機(308)用于視頻信號采集，由將視頻信號數(shù)字化并編碼壓縮，通過無線網(wǎng)絡(luò)和以太網(wǎng)將視頻或圖像數(shù)據(jù)傳送至控制設(shè)備。
[0038]9.舵機(311)為路由設(shè)備投放裝置提供動力，由控制板發(fā)出的脈沖信號控制，根據(jù)脈沖信號轉(zhuǎn)動特定角度。
[0039]10.Wifi路由設(shè)備存放倉(309)用于Wifi路由設(shè)備存放。
[0040]11.轉(zhuǎn)盤(310)用于Wifi路由設(shè)備投放控制。
[0041 ]路由設(shè)備投放裝置結(jié)構(gòu)如圖4和圖5所示，主要包括Wifi路由設(shè)備存放倉(309)和轉(zhuǎn)盤(310)，Wifi路由設(shè)備存放倉(309)在上部，底部為帶有投放窗口的轉(zhuǎn)盤，舵機(311)的傳動軸連接舵盤(312)通過轉(zhuǎn)盤連接孔(317)和螺釘連接在轉(zhuǎn)盤(310)上，舵機帶動轉(zhuǎn)盤轉(zhuǎn)動將投放窗口(314)轉(zhuǎn)至Wifi路由設(shè)備(106)下方，Wifi路由設(shè)備(106)在重力作用下離開存放倉。
[0042]如圖6所示為機器人的主控單元，包括:
[0043]1.主控板(601)，是機器人控制的核心部件，板上元件包括核心處理器、存儲單元、電源與時鐘單元、姿態(tài)傳感器的電機驅(qū)動單元;主控板還通過各類接口連接板外的各模塊或功能設(shè)備。
[0044]2.核心處理器(602)，采用三星S3C2440處理器，S3C2440是基于ARM920T內(nèi)核的微處理器，具有3個UART接口，2個SPI接口，2個USB接口，I個IIC-BUS接口 ；搭載Linux系統(tǒng)。
[0045]3.存儲單元(603);包括256M NAND Flash、一片4M NOR Flash、128M SDRAM、一片IIC-BUS接口的 EEPR0M。
[0046]4.電源與時鐘模塊(604)包括電壓轉(zhuǎn)換和時鐘管理元件，DC電壓轉(zhuǎn)換均采用MAX1724系列電源芯片，為所有芯片供電；選用12MHz晶振。
[0047]5.姿態(tài)傳感器(605)，采用invensense公司的MPU9150，該傳感器內(nèi)部包含三軸陀螺儀、三軸加速度計和一個AK8975三軸磁強計的MEMS器件，具有封裝體積小，讀寫配置方便的優(yōu)點，MPU-9150內(nèi)部分別自帶了 16位的A/D，將其測量的模擬量，轉(zhuǎn)化為可輸出的數(shù)字量，