本發(fā)明涉及一種高動態(tài)慣性導(dǎo)航等領(lǐng)域，特別是一種微機械速率積分環(huán)陀螺的控制系統(tǒng)。
背景技術(shù)：
陀螺是一種能測量載體相對慣性空間旋轉(zhuǎn)的裝置。它被廣泛應(yīng)用于軍事、自動化、導(dǎo)航和民用領(lǐng)域。雖然慣性導(dǎo)航的未來趨勢是尺寸更小，可靠性更高，成本更低，精度更高，但在實際應(yīng)用中，高動態(tài)的需求往往被忽略。在實際的彈載應(yīng)用中，高動態(tài)對陀螺提出了更嚴(yán)格的要求。因此，大量程的速率積分陀螺成為最好的解決方案。速率積分陀螺擴大了動態(tài)量程，消除了由數(shù)字和電子綜合引入的累積誤差，在實際中具有廣泛的應(yīng)用前景。環(huán)陀螺采用諧振環(huán)式全對稱結(jié)構(gòu)作為敏感結(jié)構(gòu)，方便不同模態(tài)之間的匹配，并且大大降低了環(huán)境溫度、加速度、振動、沖擊等外界擾動的影響。
密歇根大學(xué)的M.W.Putty最早研究了振動環(huán)陀螺的檢測原理，并采用在絕緣模型上電鍍鎳的方法制作了一個電容間隙為7um，深度比約為7的陀螺。這種方法制作的陀螺由于受到制作絕緣模型的材料的影響，品質(zhì)因數(shù)不會很高，限制了陀螺性能的進一步提高。2012年，密歇根大學(xué)研制的多筒速率積分陀螺CING(Cylindrical Rate-Integrating Gyroscope)，由于控制系統(tǒng)高度集成化，無法進行擴展。
技術(shù)實現(xiàn)要素：
本發(fā)明的目的在于克服現(xiàn)有技術(shù)的上述不足，提供一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，實現(xiàn)了一個統(tǒng)一的、通用的、易實現(xiàn)的速率積分環(huán)陀螺的控制系統(tǒng)，可以實現(xiàn)環(huán)陀螺在不同模式之間的切換。
本發(fā)明的上述目的是通過如下技術(shù)方案予以實現(xiàn)的：
一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，包括C/V變換模塊、環(huán)陀螺表頭、信號驅(qū)動反饋模塊、數(shù)字信號微處理器模塊；
C/V變換模塊：接收環(huán)陀螺表頭傳來的初始電容信號，將初始電容信號轉(zhuǎn)換為電壓信號，并將電壓信號傳輸至信號驅(qū)動反饋模塊；
信號驅(qū)動反饋模塊：接收C/V變換模塊傳來的電壓信號；對電壓信號依次進行濾波、放大處理，生成模擬電壓信號，將模擬電壓信號轉(zhuǎn)換為數(shù)字電壓信號，并將數(shù)字電壓信號輸出至數(shù)字信號微處理器模塊；接收數(shù)字信號微處理器模塊傳來的數(shù)字驅(qū)動電壓信號，將數(shù)字驅(qū)動電壓信號轉(zhuǎn)換為模擬驅(qū)動電壓信號，將模擬驅(qū)動電壓信號轉(zhuǎn)換為環(huán)陀螺表頭的電容信號調(diào)節(jié)控制信號，并將電容信號調(diào)節(jié)控制信號發(fā)送至環(huán)陀螺表頭；
數(shù)字信號微處理器模塊：接收信號驅(qū)動反饋模塊傳來的數(shù)字電壓信號；對數(shù)字電壓信號進行信號解調(diào)和參數(shù)提取，得到環(huán)路控制參數(shù)；對環(huán)路控制參數(shù)依次進行幅度控制、穩(wěn)頻控制、正交抵消、角度計算和參數(shù)調(diào)制，生成數(shù)字驅(qū)動電壓信號，將數(shù)字驅(qū)動電壓信號反饋至信號驅(qū)動反饋模塊；同時將環(huán)路控制參數(shù)中角度計算的結(jié)果輸出至外部測試儀器；
環(huán)陀螺表頭：接收信號驅(qū)動反饋模塊傳來的電容信號調(diào)節(jié)控制信號，對初始電容信號的穩(wěn)定性進行調(diào)節(jié)，保證了環(huán)陀螺的輸出精度。
在上述的一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，所述信號驅(qū)動反饋模塊包括濾波放大模塊、A/D模數(shù)轉(zhuǎn)換模塊、高速串行接口、D/A數(shù)模轉(zhuǎn)換模塊、驅(qū)動模塊和電壓控制器；
濾波放大模塊：接收C/V變換模塊傳來的電壓信號，對電壓信號依次進行濾波、放大處理，生成模擬電壓信號，并將模擬電壓信號傳輸至A/D模數(shù)轉(zhuǎn)換模塊；
A/D模數(shù)轉(zhuǎn)換模塊：接收濾波放大模塊傳來的模擬電壓信號，將模擬電壓信號轉(zhuǎn)換為數(shù)字電壓信號，并將數(shù)字電壓信號經(jīng)高速串行接口輸至數(shù)字信號微處理器模塊；
D/A數(shù)模轉(zhuǎn)換模塊：接收環(huán)路控制模塊傳來的數(shù)字驅(qū)動電壓信號，將數(shù)字驅(qū)動電壓信號轉(zhuǎn)換為模擬驅(qū)動電壓信號，并將模擬驅(qū)動電壓信號發(fā)送至驅(qū)動模塊；
驅(qū)動模塊：接收D/A數(shù)模轉(zhuǎn)換模塊傳來的模擬驅(qū)動電壓信號，將模擬驅(qū)動電壓信號轉(zhuǎn)換為環(huán)陀螺表頭的電容信號調(diào)節(jié)控制信號，并將電容信號調(diào)節(jié)控制信號輸出至環(huán)陀螺表頭。
在上述的一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，所述數(shù)字信號微處理器模塊包括環(huán)路控制模塊、串行外設(shè)接口和異步通信接口；
環(huán)路控制模塊：通過串行外設(shè)接口，接收經(jīng)過高速串行接口從A/D模數(shù)轉(zhuǎn)換模塊傳來的數(shù)字電壓信號；對數(shù)字電壓信號進行信號解調(diào)和參數(shù)提取，得到環(huán)路控制參數(shù)；對環(huán)路控制參數(shù)依次進行幅度控制、穩(wěn)頻控制、正交抵消、角度計算和參數(shù)調(diào)制，生成數(shù)字驅(qū)動電壓信號，將數(shù)字驅(qū)動電壓信號依次通過串行外設(shè)接口、高速串行接口反饋至D/A數(shù)模轉(zhuǎn)換模塊；同時將環(huán)路控制參數(shù)中角度計算的結(jié)果通過異步通信接口輸出至外部測試儀器。
在上述的一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，所述環(huán)路控制參數(shù)包括主軸振動幅度a、正交幅度q、計算得到的角度值θ和陀螺諧振和參考信號之間的相移誤差δφ。
在上述的一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，所述計算得到的角度值θ為-90°～90°。
在上述的一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，所述幅度控制為將主軸振動幅度a的幅度值保持穩(wěn)定；所述穩(wěn)頻控制為保證陀螺諧振和參考信號之間的相移誤差δφ的相移值穩(wěn)定；所述正交抵消為將正交幅度q的幅度值抵消為0；所述角度計算為將計算得到的角度值θ從-90°～90°拓展為全量程。
在上述的一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，所述全量程為-180°-180°。
在上述的一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，所述電容值波動越大，環(huán)陀螺的輸出角度值誤差越大。
本發(fā)明與現(xiàn)有技術(shù)相比具有如下優(yōu)點：
(1)本發(fā)明采用了數(shù)字信號微處理器模塊對環(huán)陀螺表頭進行控制，通過串行外設(shè)接口傳輸檢測信號和驅(qū)動信號，實現(xiàn)了一個統(tǒng)一的、通用的、易實現(xiàn)的速率積分環(huán)陀螺的控制系統(tǒng)；
(2)本發(fā)明采用了數(shù)字電壓信號進行環(huán)陀螺的參數(shù)提取和調(diào)制，方便在不同平臺之間進行移植；
(3)本發(fā)明對控制參數(shù)依次進行幅度控制、穩(wěn)頻控制和正交抵消，降低了控制的復(fù)雜性，提高了控制的精度。
附圖說明
圖1為本發(fā)明控制系統(tǒng)的結(jié)構(gòu)示意圖。
具體實施方式
下面結(jié)合附圖和具體實施例對本發(fā)明作進一步詳細(xì)的描述：
如圖1所示為控制系統(tǒng)的結(jié)構(gòu)示意圖，由圖可知，一種微機械速率積分環(huán)陀螺的控制系統(tǒng)，其特征在于：包括C/V變換模塊、環(huán)陀螺表頭、信號驅(qū)動反饋模塊、數(shù)字信號微處理器模塊；
C/V變換模塊：接收環(huán)陀螺表頭傳來的初始電容信號，將初始電容信號轉(zhuǎn)換為電壓信號，并將電壓信號傳輸至信號驅(qū)動反饋模塊；
信號驅(qū)動反饋模塊：接收C/V變換模塊傳來的電壓信號；對電壓信號依次進行濾波、放大處理，生成模擬電壓信號，將模擬電壓信號轉(zhuǎn)換為數(shù)字電壓信號，并將數(shù)字電壓信號輸出至數(shù)字信號微處理器模塊；接收數(shù)字信號微處理器模塊傳來的數(shù)字驅(qū)動電壓信號，將數(shù)字驅(qū)動電壓信號轉(zhuǎn)換為模擬驅(qū)動電壓信號，將模擬驅(qū)動電壓信號轉(zhuǎn)換為環(huán)陀螺表頭的電容信號調(diào)節(jié)控制信號，并將電容信號調(diào)節(jié)控制信號發(fā)送至環(huán)陀螺表頭；
數(shù)字信號微處理器模塊：接收信號驅(qū)動反饋模塊傳來的數(shù)字電壓信號；對數(shù)字電壓信號進行信號解調(diào)和參數(shù)提取，得到環(huán)路控制參數(shù)；對環(huán)路控制參數(shù)依次進行幅度控制、穩(wěn)頻控制、正交抵消、角度計算和參數(shù)調(diào)制，生成數(shù)字驅(qū)動電壓信號，將數(shù)字驅(qū)動電壓信號反饋至信號驅(qū)動反饋模塊；同時將環(huán)路控制參數(shù)中角度計算的結(jié)果輸出至外部測試儀器；
環(huán)陀螺表頭：接收信號驅(qū)動反饋模塊傳來的電容信號調(diào)節(jié)控制信號，對初始電容信號的穩(wěn)定性進行調(diào)節(jié)，保證了環(huán)陀螺的輸出精度。電容值波動越大，環(huán)陀螺的輸出角度值誤差越大。
其中，所述信號驅(qū)動反饋模塊包括濾波放大模塊、A/D模數(shù)轉(zhuǎn)換模塊、高速串行接口、D/A數(shù)模轉(zhuǎn)換模塊、驅(qū)動模塊和電壓控制器；
濾波放大模塊：接收C/V變換模塊傳來的電壓信號，對電壓信號依次進行濾波、放大處理，生成模擬電壓信號，并將模擬電壓信號傳輸至A/D模數(shù)轉(zhuǎn)換模塊；
A/D模數(shù)轉(zhuǎn)換模塊：接收濾波放大模塊傳來的模擬電壓信號，將模擬電壓信號轉(zhuǎn)換為數(shù)字電壓信號，并將數(shù)字電壓信號經(jīng)高速串行接口輸至數(shù)字信號微處理器模塊；
D/A數(shù)模轉(zhuǎn)換模塊：接收環(huán)路控制模塊傳來的數(shù)字驅(qū)動電壓信號，將數(shù)字驅(qū)動電壓信號轉(zhuǎn)換為模擬驅(qū)動電壓信號，并將模擬驅(qū)動電壓信號發(fā)送至驅(qū)動模塊；
驅(qū)動模塊：接收D/A數(shù)模轉(zhuǎn)換模塊傳來的模擬驅(qū)動電壓信號，將模擬驅(qū)動電壓信號轉(zhuǎn)換為環(huán)陀螺表頭的電容信號調(diào)節(jié)控制信號，并將電容信號調(diào)節(jié)控制信號輸出至環(huán)陀螺表頭。
所述數(shù)字信號微處理器模塊包括環(huán)路控制模塊、串行外設(shè)接口和異步通信接口；
環(huán)路控制模塊：通過串行外設(shè)接口，接收經(jīng)過高速串行接口從A/D模數(shù)轉(zhuǎn)換模塊傳來的數(shù)字電壓信號；對數(shù)字電壓信號進行信號解調(diào)和參數(shù)提取，得到環(huán)路控制參數(shù)，環(huán)路控制參數(shù)包括主軸振動幅度a、正交幅度q、計算得到的角度值θ和陀螺諧振和參考信號之間的相移誤差δφ；θ范圍為-90°～90°；對環(huán)路控制參數(shù)依次進行幅度控制、穩(wěn)頻控制、正交抵消、角度計算和參數(shù)調(diào)制，生成數(shù)字驅(qū)動電壓信號，將數(shù)字驅(qū)動電壓信號依次通過串行外設(shè)接口、高速串行接口反饋至D/A數(shù)模轉(zhuǎn)換模塊；同時將環(huán)路控制參數(shù)中角度計算的結(jié)果通過異步通信接口輸出至外部測試儀器。
其中，幅度控制為將主軸振動幅度a的幅度值保持穩(wěn)定；所述穩(wěn)頻控制為保證陀螺諧振和參考信號之間的相移誤差δφ的相移值穩(wěn)定；所述正交抵消為將正交幅度q的幅度值抵消為0；所述角度計算為將計算得到的角度值θ從-90°～90°拓展為全量程，述全量程為-180°-180°。
幅度控制的主要作用是保證振子振動的幅度恒定。幅度控制主要采用自動增益控制計數(shù)(AGC)技術(shù)來達到穩(wěn)幅的目的。自動增益控制可以根據(jù)敏感結(jié)構(gòu)幅度的大小自動調(diào)整驅(qū)動信號的幅度，即可以保持敏感結(jié)構(gòu)振幅的穩(wěn)定，又可以在上電過程中減少振子達到穩(wěn)定狀態(tài)所需的時間。
穩(wěn)頻控制的作用是使陀螺振子振動在其諧振頻率上，由于陀螺敏感結(jié)構(gòu)的諧振頻率隨溫度等實時變化，因此必須采用閉環(huán)追蹤系統(tǒng)來保證驅(qū)動信號的頻率與振子的諧振頻率完全一致。
正交抵消采用PID控制器來抑制正交幅度值q。PID是一種線性控制器，它根據(jù)給定值與實際輸出值構(gòu)成控制方案。PID控制器具有結(jié)構(gòu)簡單、穩(wěn)定性好、工作可靠和調(diào)整方便等優(yōu)點，已經(jīng)成為工業(yè)控制的主要技術(shù)之一。PID控制器就是根據(jù)系統(tǒng)的誤差，利用比例、積分和微分計算出控制量進行控制的。
本發(fā)明說明書中未作詳細(xì)描述的內(nèi)容屬本領(lǐng)域技術(shù)人員的公知技術(shù)。