[發(fā)明專利]一種陀螺進(jìn)動控制裝置及方法

有效

• 申請?zhí)枺?/td>: 201210375749.5
• 申請日: 2012-09-29
• 公開（公告）號: CN103712611A
• 公開（公告）日: 2014-04-09
• 發(fā)明（設(shè)計）人: 王恩德;佟新鑫;朱丹;劉曉安;王旭;栗蕭峰
• 申請（專利權(quán)）人: 中國科學(xué)院沈陽自動化研究所
• 主分類號: G01C19/04
• 分類號: G01C19/04
• 代理公司: 沈陽科苑專利商標(biāo)代理有限公司 21002
• 代理人: 周秀梅;許宗富

技術(shù)領(lǐng)域

本發(fā)明涉及陀螺進(jìn)動控制技術(shù)，具體地說是一種陀螺進(jìn)動控制的方法及裝置，應(yīng)用于頻率測量和陀螺進(jìn)動控制等領(lǐng)域。

背景技術(shù)

陀螺儀是一種能夠精確地確定運動物體的方位的儀器，它是現(xiàn)代航空、航海、航天和工業(yè)中廣泛使用的一種慣性導(dǎo)航儀器，它的發(fā)展對一個國家的工業(yè)和其它高科技的發(fā)展具有十分重要的意義。位置和頻率測量是陀螺速度穩(wěn)定控制領(lǐng)域當(dāng)中兩個輸入，這兩個輸入是進(jìn)動控制的基礎(chǔ)。進(jìn)動特性是陀螺的一個重要特性，利用該特性可以實現(xiàn)陀螺的定向偏轉(zhuǎn)，具體可以應(yīng)用在導(dǎo)航等領(lǐng)域。

在現(xiàn)有的系統(tǒng)中，通常利用慣性系作為陀螺進(jìn)動的基準(zhǔn)，當(dāng)陀螺移動時會影響進(jìn)動精度；采用DAC模塊生成正弦波，這樣增加了硬件成本；在進(jìn)動控制中，采用算法計算進(jìn)動方位和幅度與進(jìn)動控制信號的幅度和相位的映射關(guān)系，占用微控制器的資源，算法實時性差。

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

針對現(xiàn)有技術(shù)的不足，本發(fā)明提供一種陀螺進(jìn)動控制的方法及裝置。

本發(fā)明為實現(xiàn)上述目的所采用的技術(shù)方案是：一種陀螺進(jìn)動控制裝置，包括：順序連接的預(yù)處理電路、微控制器、低通濾波器、功率放大器和陀螺驅(qū)動；預(yù)處理電路：將來自傳感器的陀螺反饋信息進(jìn)行放大整形后輸出至微控制器；微控制器：接收上位機的進(jìn)動位置信息，完成進(jìn)動位置信息和進(jìn)動控制信息之間的映射，利用脈寬調(diào)制技術(shù)將進(jìn)動控制信息通過改變脈寬調(diào)制的占空比轉(zhuǎn)換成正弦波；低通濾波器：將微控制器輸出的正弦波濾掉高頻成分；功率放大器：將低通濾波器的控制信號進(jìn)行放大后輸出至陀螺驅(qū)動使陀螺進(jìn)動。

所述陀螺反饋信息包括陀螺轉(zhuǎn)子的位置和轉(zhuǎn)速。

所述進(jìn)動控制信息包括陀螺轉(zhuǎn)子的頻率、幅度和相位。

所述進(jìn)動控制信息中的頻率根據(jù)陀螺反饋信息的轉(zhuǎn)速得出。

一種陀螺進(jìn)動控制方法，包括以下步驟：

1）查詢陀螺轉(zhuǎn)子的轉(zhuǎn)動周期是否到來；

2）如果到來，則測量陀螺轉(zhuǎn)子的轉(zhuǎn)速；如果沒到來，則返回步驟5）；

3）接收上位機的進(jìn)動位置信息，包括陀螺轉(zhuǎn)子的幅度和方位；

4）在進(jìn)動位置信息與進(jìn)動控制信息之間進(jìn)行插值映射；所述進(jìn)動控制信息包括陀螺轉(zhuǎn)子的頻率、幅度和相位。

5）查詢脈寬調(diào)制間隔是否到來；

6）如果到來，則輸出脈寬調(diào)制波；如未到來，則返回步驟1）；

7）脈寬調(diào)制的正弦波經(jīng)低通濾波器濾掉高頻成分，再通過功率放大器進(jìn)行信號放大后輸出至陀螺驅(qū)動使陀螺進(jìn)動。

所述步驟4）對進(jìn)動的位置和進(jìn)動控制信息進(jìn)行插值映射包括以下步驟：

A．對陀螺進(jìn)動的幅度和相位數(shù)據(jù)中的特殊點做成二維表；

B．在二維表中搜索離設(shè)定的進(jìn)動幅度和相位最近的兩個點；

C.利用線性插值的方法進(jìn)行插值，得到進(jìn)動控制信息的幅度和相位。

7．根據(jù)權(quán)利要求6所述的一種陀螺進(jìn)動控制方法，其特征在于：

所述特殊點為在陀螺頂面上不同半徑的同心圓圓周與不同圓心角的交點。

所述脈寬調(diào)制間隔是通過定點采樣設(shè)定的。

所述輸出脈寬調(diào)制波包括以下步驟：

c．將映射所得的正弦波幅度轉(zhuǎn)換為脈寬調(diào)制的最大占空比；

d．將映射所得的正弦波相位與陀螺反饋的位置信息中的方位進(jìn)行比較，將所得相位差數(shù)字化并轉(zhuǎn)換為時間差，該時間差作為脈寬調(diào)制的50%占空比時刻；

c．將陀螺反饋的轉(zhuǎn)速轉(zhuǎn)換成頻率，作為占空比改變一個周期的頻率，即可得到高頻調(diào)制的正弦波。

本發(fā)明具有以下有益效果及優(yōu)點：

1.本發(fā)明利用陀螺反饋信號測量陀螺轉(zhuǎn)子的位置及轉(zhuǎn)速作為陀螺進(jìn)動的參考基準(zhǔn)，提高了陀螺進(jìn)動的控制精度。

2.本發(fā)明利用脈寬調(diào)制技術(shù)生成正弦波，節(jié)約了成本，減少了電路復(fù)雜度。

3.本發(fā)明利用線性插值技術(shù)將進(jìn)動幅度和方位與進(jìn)動控制信號的幅度和相位進(jìn)行映射，降低了算法的復(fù)雜度。

附圖說明

圖1為本發(fā)明硬件原理示意圖；

圖2為本發(fā)明脈寬調(diào)制生成正弦波原理示意圖；

圖3為本發(fā)明進(jìn)動幅度方位與進(jìn)動控制信號映射原理示意圖；

圖4為本發(fā)明陀螺進(jìn)動控制方法流程圖。

具體實施方式

下面結(jié)合附圖及實施例對本發(fā)明做進(jìn)一步的詳細(xì)說明。

采用信號處理技術(shù)對陀螺反饋信號進(jìn)行預(yù)處理，然后將預(yù)處理過的反饋信號分別處理成速度反饋和轉(zhuǎn)子反饋并輸入微處理器，通過處理和計算得當(dāng)前時刻陀螺的位置和轉(zhuǎn)速，根據(jù)實時輸入的進(jìn)動方向和幅度調(diào)整進(jìn)動信號，然后經(jīng)過功率放大器進(jìn)行輸出，實現(xiàn)系統(tǒng)的進(jìn)動控制。