通過地 面AD模塊轉換處理后，由通信模塊發送至DSP1 ;通信模塊負責各模塊數據交換，并將導航 解算后的位姿數據通過通信模塊W 10化頻率傳給上位機。 陽154] 參考文獻：
[0155] [1]李大威.卡爾曼濾波器在INS_GI^S組合導航中的應用研究巧].太原：中北大 學，2006 陽156] [2]袁克非.組合導航系統多源信息融合關鍵技術研究巧].哈爾濱：哈爾濱工程 大學，2012 陽157] [3]肖乾.多傳感器組合導航系統信息融合技術研究巧].哈爾濱：哈爾濱工程大 學，2005
【主權項】
1. 一種基于組合導航技術的超深礦井罐籠位姿測量系統，其特征在于，包括捷聯慣性 導航裝置、地面處理裝置、旋轉編碼器、接近開關和感應通信電纜； 所述捷聯慣性導航系統安裝在罐籠頂部； 所述旋轉編碼器安裝在提升機卷筒的卷軸上； 所述感應通信電纜鋪設于礦井側壁； 所述接近開關設置在井筒壁上； 所述旋轉編碼器和接近開關與安裝在礦井地表面的地面處理裝置進行通信連接，所述 地面處理裝置通過感應通信電纜與捷聯慣性導航裝置進行通信連接； 以捷聯慣性導航系統、接近開關和旋轉編碼器構建成組合導航式位姿測量系統。2. 根據權利要求1所述的一種基于組合導航技術的超深礦井罐籠位姿測量系統，其特 征在于，所述捷聯慣性導航系統包括慣性單元、數據采集及處理模塊、導航解算及信息融合 模塊、數據存儲模塊及通信模塊； 所述慣性單元通過SPI總線與數據采集及處理模塊相連，所述數據采集及處理模塊與 導航解算及信息融合模塊相連，所述數據采集及處理模塊與導航解算及信息融合模塊均與 所述數據存儲模塊相連，所述數據存儲模塊與通信模塊相連。3. 根據權利要求2所述的一種基于組合導航技術的超深礦井罐籠位姿測量系統，其特 征在于，所述數據采集及處理模塊與導航解算及信息融合模塊均采用TI公司的TMS320系 列C6748浮點型DSP處理器。4. 一種基于組合導航技術的超深礦井罐籠位姿測量方法，其特征在于，將數據采集與 處理和導航解算與信息融合分配給兩個不同的處理器處理； 所述數據采集與處理的過程如下： 首先讀取捷聯慣性導航系統中的慣性單元的數據，根據慣性單元偏置溫度系數進行線 性溫度誤差補償，然后讀取地面處理裝置數據，最后存儲數據，上傳數據至上位機； 所述導航解算與信息融合的過程如下： 通過將捷聯慣性導航系統安裝在罐籠頂部，利用捷聯慣性導航系統的慣性單元測量出 罐籠運動加速度和角速度，采用四元數法建立罐籠姿態矩陣，通過SINS解算出罐籠位置和 姿態信息；通過地面處理裝置采集井筒壁上的接近開關和提升機卷筒軸上的旋轉編碼器測 量罐籠的位置和速度，采用聯合卡爾曼濾波算法將捷聯慣性導航系統的速度和位置信息與 罐籠位置與速度進行信息融合，反饋校正捷聯慣性導航系統，實現罐籠位置和姿態的精確 測量。5. 根據權利要求4所述的一種基于組合導航技術的超深礦井罐籠位姿測量方法，其特 征在于，所述信息融合的步驟如下： 步驟1 :建立捷聯慣性導航系統誤差模型，包括三軸陀螺儀誤差模型、加速度測量誤差 模型、位置誤差模型及姿態角誤差模型； 步驟2 :以步驟1中的捷聯慣性導航系統誤差模型建立離散化的組合導航式位姿測量 系統的狀態方程； 所述組合導航式位姿測量系統是指由捷聯慣性導航系統、接近開關和旋轉編碼器組 成； 步驟3 :構建信息融合卡爾曼濾波器，并依據組合導航式位姿測量系統的狀態向量建 立信息融合卡爾曼濾波器中各子濾波器的觀測方程，求得各子濾波器的狀態向量估計值； 所述信息融合卡爾曼濾波器包括第一子濾波器、第二子濾波器、第三子濾波器以及主 濾波器，所述第一子濾波器、第二子濾波器及第三子濾波器均與主濾波器相連； 所述第一子濾波器、第二子濾波器、第三子濾波器以及主濾波器均為卡爾曼濾波器； 將捷聯慣性導航系統的速度與編碼器速度之差作為第一子濾波器的輸入信號； 將捷聯慣性導航系統的位置信號與接近開關位置信號之差作為第二子濾波器的輸入 信號； 將捷聯慣性導航系統的東、北方向的零速度和零位置信號作為約束條件，構造成虛擬 信號作為第三子濾波器的輸入信號； 第一子濾波器的觀測方程為第一子濾波器觀測向量Z1GO = [Vu-Vb]，Vb為地面處理裝置基于旋轉編碼器計算得 到的罐籠速度，V1GO為第一子濾波器觀測噪聲，是均值為零的高斯白噪聲序列，由高斯 函數可得，X 1GO為第一子濾波器的狀態向量，第一子濾波器觀測矩陣H1GO = [〇lxs 1 〇1Χ6] 1X15; 第二子濾波器的觀測方程為：第二子濾波器觀測向量Z2GO = [Η-Η,]，H為捷聯慣性導航系統解算出的罐籠垂直位 置，Η,為接近開關位置信號，V2GO為第二子濾波器位置觀測噪聲，是均值為零的高斯白噪 聲序列；X 2(k)為第二子濾波器的狀態向量，H2GO = [01X5 I 01Χ9] 1Χ15為第二子濾波器位置 觀測矩陣； 第三子濾波器觀測方程為第三子濾波器觀測向量Z3GO = [L E Ve vn]T，L和E為捷聯慣性導航系統東向和西向 位置，\和Vn為捷聯慣性導航系統東向和西向速度，V3GO為第三子濾波器觀測噪聲，是均 值為零的高斯白噪聲序列；X 3GO為第三子濾波器的狀態向量； 第三子濾波器觀測矩陣H3GO為：k表示離散時刻； 步驟4 :按照如下規則將組合導航式位姿測量系統整體的過程信息包括Q1 (k)、龍(k) 及P1 (k)平均分配到各子濾波器：其中及P1GO分別為各濾波器的噪聲方差陣、狀態估計向量、估計誤差協 方差，i = 1，2, 3，m ;分別為組合導航式位姿測量系統的噪聲方差陣、狀態估計向量、 估計誤差協方差；肩:1戊)為分配參數β i (k)的倒數；,E □是期望函數，的初始值為[0]1X15; 由步驟3的觀測方程求得，為各濾波器的噪聲向量； 步驟5 :基于步驟4所得各濾波器的噪聲方差矩陣、狀態估計向量、估計誤差協方差即 Q1 (k)、為(k)及P1 (k)，按照以下公式將各濾波器狀態估計與估計誤差協方差按組合導航式 位姿測量系統的轉移矩陣進行轉移，得到各濾波器轉移后的狀態估計向量和估計誤差協方 差； 步驟6 :利用步驟5所得各濾波器轉移后的狀態估計向量與估計誤差協方差，采用如下 測量方程，對元(10、KjkhPjk)按以下公式進行更新：其中，i = 1，2, 3, m，當i = m時，Pm(k) = Pm(k, k-1) !Ki為各濾波器的增益矩陣，R ;為 各濾波器觀測噪聲的協方差矩陣，R1=Ek JlOv1 (k)T]/T，\為各濾波器觀測白噪聲序列， I為15X 15的單位矩陣；T為慣性單元采樣周期，P1 (k，k-Ι)為轉移估計誤差協方差陣， 步驟7 :將各子濾波器的估計信息按照下式進行融合，得到組合導航式位姿測量系統 的狀態估計與估計誤差協方差全局最優估計^、Pg，并返回步驟4,依據^、Pg將組合導航 式位姿測量系統的過程信息對各子濾波器進行重新分配，對各濾波器進行反饋修正：
【專利摘要】本發明公開了一種基于組合導航技術的超深礦井罐籠位姿測量系統及方法，設計了捷聯慣性導航系統/接近開關/旋轉編碼器組合導航式位姿測量系統。慣性單元測量出罐籠運動加速度和角速度，通過導航系統解算出罐籠位置和姿態信息，采用接近開關和旋轉編碼器測量罐籠的位置和速度，通過信息融合得到罐籠速度和位置的最優估計，反饋校正捷聯導航系統，實現罐籠位置和姿態的精確測量。本發明檢測精度不受礦井深度和提升鋼絲繩的彈性伸長、打滑、蠕動、纏繞半徑變化等影響，能實時有效的監測罐籠位姿狀態，提供傾斜預警及精確定位，滿足超深礦井對位姿檢測系統的要求。
【IPC分類】B66B3/02, B66B5/00
【公開號】CN105173940
【申請號】
【發明人】譚建平, 林波, 劉淑奇, 薛少華, 吳志鵬
【申請人】中南大學
【公開日】2015年12月23日
【申請日】2015年7月16日