基于CMOS HMC5883 MPU6050的模擬滅火訓練系統
需要注意的是,噴口朝向計算需要進行初始化,初始化的目的是保證在程序啟動時,噴口朝向的方向是垂直于屏幕的,否則對于水平面上角度的檢測將會出錯。
本文引用地址:http://www.104case.com/article/281896.htm4 通信與數據整合
本套系統共有3個數據采集模塊,分別是:滅火器模塊、1號攝像頭模塊、2號攝像頭模塊。這三個模塊同時向系統主機發送數據,都是通過nRF24L01無線模塊完成的。
nRF24L01是由NORDIC生產的工作在2.4GHz~2.5GHz的ISM 頻段的單片無線收發器芯片。輸出功率頻道選擇和協議的設置可以通過SPI 接口進行設置,幾乎可以連接到各種單片機芯片,并完成無線數據傳送工作。且功耗很低,接收時工作電流12.3mA,0dBm功率發射時11.3mA,掉電模式時僅為900nA。是十分簡單易用的無線數傳模塊。
本文將3個數據采集模塊端的內置nRF24L01模塊設置成發送模式,系統主機端需要插入一塊nRF24L01轉USB協議的接收模塊。該模塊內的nRF24L01設置成接收模式,專門負責接收3個數據采集模塊傳送過來的數據并將數據打包通過USB端口傳給上位機系統。需要注意的是為了防止3個數據模塊傳送過來的數據交叉混亂,接收端nRF24L01需要啟用3個數據通道分別接收來自3個數據采集模塊的數據[6]。
收集到3組數字后,形成新的一個數據包。通過USB-HID協議發送給上位機電腦。數據包格式如表1。
數據包總共包括17個字節。第0位和第16位分別是開始和結束位。數據位1~4是1號攝像頭捕捉到的信息,分別代表橫坐標的高地位和縱坐標的高地位。5~8位是2號攝像頭捕捉到的信息。數據位9~14位是航姿檢測捕捉到的角度信息,分別代表X,Y,Z三軸的旋轉角度信息。第15位代表滅火器按壓信號。接收模塊展示如圖4。
在取得3組數據后,上位機需要通過3組數據計算出滅火器噴口射出的射線打在屏幕上的點的位置。首先我們取1號攝像機的空間坐標為P1,2號攝像機的空間坐標為P2。我們約定P1,P2的連線是平行于屏幕水平面的。根據點P1和1號攝像頭傳輸的數據(cx2,cy2)可以確定唯一一條直線,
,其中d1為1號攝像頭指向紅外點的方向向量量。同理可由P2,(cx2 ,cy2)得到
。通過解方程
可求得:
t1為直線上到
最近的點與P1的距離。
理論上,應為兩臺攝像機看到的是同一個LED燈,所以直線和
必有一交點。實際由于圖像識別誤差等原因,
和
不一定相交。本文可以通過取
,得到(cx1,cy),(cx2,cy)。重新計算
和
,解方程后通過t1求得兩條直線的焦點P3。此點即為滅火器模型噴口上紅外點的空間坐標。
最后通過模型滅火器模塊測得的噴口朝向(一組歐拉角),轉化成方向向量d3。可以得到第三條射線。這條射線可視為噴口射出的彈道線。
5 火災模擬軟件
火災模擬訓練的上位機程序通過游戲引擎Unity編寫。Unity是一款多平臺、綜合性游戲開發工具。模擬訓練的場景模型通過3dsMAX建模并導入Unity[7]。
系統啟動后,根據前一章介紹的方法計算出滅火器噴口射出的彈道線落在屏幕上的實時位置,再加上滅火器模型的噴氣按壓信號,訓練者可以完成在大屏幕上的選中、確認操作。實現通過滅火器與投影屏幕的互動工作。
同時,本系統設計了多個火災發生場景,包括廚房、客廳、臥室等。針對不同的起火原因,引導受訓者選擇不同類型的滅火器,正確的撲滅火災。通過噴口定位系統可以更好地指導訓練者在使用滅火器時應注意的一些事項。如使用滅火器滅火時應距離起火點多遠,噴口應對準火焰的上方還是下方。
6 結論
針對滅火模擬訓練的需求,結合虛擬現實、室內定位、航姿檢測等技術,實現了模擬滅火訓練系統。該系統應用100寸投影大屏,讓訓練者身臨其境,感受火災現場氛圍。同時模擬滅火器不僅可以作為訓練道具,還提供了精準的人機交互功能,操作性強。為解決以往滅火訓練不安全、不經濟、不環保等問題提供的新的思路。
參考文獻:
[1]張云明,陳蕾.基于虛擬現實技術的滅火救援訓練系統[J].消防科學與技術,2010,(11):996-997
[2]王興波,袁狄平,靳學勝.滅火救援行動單兵仿真模擬訓練系統研究[J].系統仿真學報,2014,26(6):1137-1138
[3]李文斌.基于DSP的射擊訓練系統設計與實現[D].成都:西南交通大學,2009: 4-7
[4]武麗敏,蘇寒松.蔡桂方/數字實景游戲中的智能紅外激光槍系統設計與實現[J].電子測量技術,2011,5:103-106
[5]孫麗,秦永元.捷聯慣導系統姿態算法比較[J].中國慣性技術學報,2006,6:6-8
[6]李輝,宋詩,周建江.基于ARM和nRF24L01的無線數據傳輸系統[J].國外電子元器件,008,12:10-12
[7]黃濤,黃健民.基于Unity3D的虛擬校園漫游系統的研究和實現[D].廣西壯族自治區:廣西師范法學,2014:5-6
評論