【発明の詳細な説明】
レーザージャイロ直接ディザ駆動装置
本発明は、一般に、レーザージャイロに関し、さらに特定すれば、閉ループシ
ステムでマイクロ制御装置を使用してレーザージャイロディザモータを直接デジ
タル駆動する方法及び装置に関する。
発明の背景
レーザージャイロと呼ばれることも多いレーザー角速度センサは良く知られて
いる。レーザー角速度センサの1例は、本明細書にも参考として取り入れられて
いるHanse他に発行された米国特許第4,751,718号である。今日の
レーザー角速度センサは、空隙を包囲するように形成された空洞を複数備えた熱
に関して安定し且つ機械的にも安定したレーザーブロックを含む。空洞の両端に
は、レーザービームを反射して、閉ループ光路を形成するミラーが配置されてい
る。
そのようなセンサと関連して、従来の技術ではこれまで認識されてきたロック
インと呼ばれる望ましくない現象がある。従来の技術では、そのようなセンサを
回転振動させる、すなわち、ディザリングすることによってロックイン現象に対
処していた。回転振動は典型的にはディザモータにより支えられる。従来のディ
ザモータは、通常、たとえば、外側リムと、中心ハブ部材と、ハブ部材から放射
状に突出し且つハブ部材とリムとの間に結合する複数のディザモータリードとを
含む懸垂システムを有する。従来は、アクチュエータとして働く1組の圧電素子
を懸垂システムに結合していた。圧電素子に電気信号を印加することによって作
動させると、懸垂システムはディザモータとして動作し、その結果、センサのブ
ロックは懸垂システムの固有機械共振周波数で角振動する。このディザ運動は慣
性空間におけるセンサの慣性回転に重ね合わされる。そのようなディザモータは
単一のレーザージャイロと関連して使用されても良く、あるいは、複数のレーザ
ージャイロをディザするために使用されても良い。従来の技術はディザ効果のな
い慣性回転データを回復するための様々な方式を含む。
発明の概要
本発明によりレーザージャイロの直接デジタルディザ駆動装置が提供される。
本発明の直接デジタル駆動装置は少なくとも3つの極を有する低域フィルタと、
少なくとも2つの極を有する高域フィルタと、フィルタリングされた信号を供給
する出力と、パルス幅変調デジタル駆動信号に接続する入力とを具備する。直接
デジタル駆動装置は、入力側で低域フィルタの出力に結合し、低域フィルタから
のフィルタリングされた信号を増幅する増幅器をさらに具備し、増幅信号に応答
してディザモータを駆動する手段は増幅器の出力に結合されており、その駆動手
段は、電力供給信号における電流スパイクをほぼ排除し、電力消費の少ないきわ
めて効率の良い駆動装置を構成するように不感帯動作特性を与える手段を含む能
動プルアップ手段を含む。
本発明の1つの目的は、0%デューティサイクルから100%デューティサイ
クルの範囲にわたるパルス幅変調入力に応答して+150〜−150ボルトの範
囲の出力を供給するディザモータ駆動手段を提供することである。
本発明の別の目的は、パルス幅変調信号入力の遷移中にのみ電力を消費する改
良されたディザ駆動回路を提供することである。
本発明のさらに別の目的は、ディザモータの容量性駆動負荷が定常状態に到達
したときに少量の電力を消費する改良されたディザ駆動回路を提供することであ
る。
本発明のその他の目的、特徴及び利点は好ましい実施例の説明、請求の範囲及
び図面によって当業者には明白になるであろう。尚、図面中、同じ図中符号は同
じ素子を指示する。
図面の簡単な説明
図1は、本発明の新規な特徴を採用するレーザージャイロの一実施例のブロッ
ク線図を示す。
図2は、本発明に従って構成されたディザピックオフ回路の一例の回路図を概
略的に示す。
図3は、本発明の1面により提供される直接デジタルディザ駆動回路の一実施
例の回路図を概略的に示す。
図4は、本発明の1面により提供されるディザ駆動回路の別の実施例の詳細な
回路図を示す。
図5は、閉ループシステムを含むレーザージャイロで使用される直接ディザ駆
動装置の高レベル概略ブロック線図を示す。
図6は、零交差検出器の出力の関数として割込みタイミング図を示す。
図7は、ディザサイクルの90°交差点及び270°交差点を確定する方法を
示す。
図8は、単一のアナログ/デジタル変換器を複数の他のモジュラジャイロ機能
の間で実行順序指定するために使用される本発明の方法及び装置の概略図を示す
。
図9は、モニタ制御ループによってモジュラジャイロを監視する方法を示す。
図10は、デジタル化され、ディザピックオフから変換されたディザピックオ
フ信号を処理する方法を示す。
図11は、駆動プロセス、ストリッパプロセス及びバックグラウンドプロセス
のいずれかにより呼び出されたときにA/D変換を処理する方法の概略図を示す
。
図12は、ソフトウェアタイマ割込みに関わる割込みサービスルーチンの概略
図を示す。
図13は、サンプルストローブを予測するために使用される本発明の方法を示
す。
図14は、複数のアナログ/デジタル変換器を利用する本発明の方法を示す。
図15は、バックグラウンドアナログ/デジタル変換を待ち合わせするための
本発明の方法を示す。
好ましい実施例の説明
そこで、本発明の新規な特徴を採用するモジュラレーザージャィロの一実施例
のブロック線図を示す図1を参照する。本発明を実施例によって説明する。この
開示の利を得た当業者は、ここで示す例が本発明の原理を例示するためのもので
あり、限定のためではないことを理解するであろう。レーザージャイロ10は制
御装置100と、レーザージャイロブロック200と、能動電流制御部300と
、ディザピックオフ増幅器400と、直接デジタルディザ駆動部500と、経路
長制御(PLC)装置600と、読出し部700と、デジタル論理800とを含
む。
一実施例では、本発明の直接デジタルディザ駆動部は制御装置100として利
用されるマイクロ制御装置を伴って実現される。ディザ駆動部はディザピックオ
フ244Aと、ディザピックオフ増幅器回路400と、A/D変換器110と、
制御装置100と、PWM1 115出力線501Bと、直接ディザ駆動部50
0と、ディザモータ204Bとを具備する閉ループシステムである。A/D変換
器110は制御装置と一体であっても良く、また、10ビットA/D変換器であ
ると有利であろう。10ビットA/D変換器は、1992年12月11日出願の
米国特許出願Serial No.07/805,122に基づく本出願人の同
時係属PCT出願「LASER GYRO DITHER STRIPPER」
の中にさらに詳細に論じられているディザストリッパの方法及び装置に対して1
0ビットの正確さを示す。制御装置100はマイクロプロセッサ120をさらに
含んでいると有利であろう。制御装置100は、信頼性が高く、コスト面で有効
であり且つ集積度の高い制御機能を提供するハードウェア周辺支援を伴うプロセ
ッサ120のコアを有する。
簡単にいえば、動作中、まず、ピックオフ電圧245Aにより表わされるPL
Gブロック位置をディザピックオフ増幅器400によって増幅する。増幅された
ディザピックオフ信号501AをA/D変換器110と、比較器(図示せず)と
へ送り、そこで、比較器は方形波501Cを発生し、その方形波は割込みの最大
周波数を制限するためにワンショット810へ送信される。ワンショット810
は約1000Hzの速度で周期的にリセットされる。ワンショットの出力は正端
零交差で制御装置を割込ませる。ディザピックオフ及び駆動部の方法は図5にさ
らに詳細に示されている。レーザーブロック位置の零交差に基づいて、マイクロ
プロセッサはディザ周期を計算し且つサンプル時間を予測する。次に、図6にさ
らに詳細に示すディザ駆動波形をディザ信号の正弦波の負のピークと正のピーク
でA/D変換器110によってサンプリングする。このサンプリングプロセスに
より、ディザモータ244Bを駆動するために要求される90度の位相ずれも得
られる。サンプリング後、A/D値を所望の利得調整変位基準と比較し、その量
を利得係数と乗算し、ランダムノイズを加算し、信号をパルス幅変調器115へ
送る。ランダムノイズはガウス雑音であると有利であろう。ピックオフスケール
係数の変動を修正するために、変位基準はディザストリッパの利得調整によって
修正される。基準変位はレーザージャイロ直接ディザ駆動システムにより周期的
な間隔でさらに調整されても良い。本発明の動作については以下にさらに詳細に
論じる。
本発明の一実施例では、マイクロ制御装置100はIntel 80C196
KC Microcontrollerから構成されている。マイクロ制御装
置100は、本発明のこの実施例においては様々な制御機能のために使用される
3つのパルス幅変調器を含む。パルス幅変調器PWM1 115はディザ駆動回
路を制御するために使用される。マイクロ制御装置100の初期設定の制御には
多数のソフトウェアモジュールが関連している。ソフトウェアプログラムはマイ
クロ制御装置100内部に含まれるマイクロプロセッサ120によって実行され
る。100%のPWM信号は−150ボルトの出力に相当し、50%のPWM信
号は0ボルトの出力に相当し、0%のPWM信号は+150ボルトの出力に相当
する。
本発明の一実施例では、パルス幅変調信号は、当初、50%デューティサイク
ルに設定される。ディザ駆動回路の一部は、駆動回路中に導入されるランダムノ
イズ量を利用する。ディザ駆動部乱数発生器は、モジュラジャイロ10の制御シ
ステムの始動時に初期設定される。
ディザ駆動回路はさらにシステム変数の初期設定によって初期設定される。シ
ステムは、レーザー発生システムの実際の変位を計算するために使用される基準
電圧を表わす。ディザ駆動回路では、正弦信号の近似であるピックオフ信号24
5Aをディザピックオフによって発生する。ピックオフ信号は角変位を表わす。
基準ピーク角度値を正弦ピックオフ信号のピークと比較し、ディザ駆動部におけ
る誤差を規定する差値を求める。次に、システムパワーアップの間に実際の基準
電圧を初期設定する。それらの基準値はEEPROM102に記憶され、電圧か
ら変位への変換を表わす。
本発明の一実施例では、ディザ駆動部は初期設定に200ミリ秒を要する。デ
ィザ駆動部はレーザーと同時に又はレーザーよりわずかに先立って始動される。
図1の実施例においては、マイクロ制御装置100には第1のタイマ及び第2
のタイマがある。第1のタイマはサンプリング機能のために使用される。第2の
タイマはディザ駆動機能及びディザストリッピング機能のために使用される。双
方のタイマを同期させる必要がある。マイクロ制御装置100のオンボード高速
出力論理は、ディザストリッピング機能に際してA/D変換などの機能を実行す
るために、タイマを同期させる。オンボード高速入力論理はリアルタイムで起こ
っている外部事象を把握し、第1のタイマのカウント値をFIFOレジスタに記
憶する。これにより、マイクロ制御装置100は外部事象を個別且つ非同期的に
把握することができる。
サンプルストローブDS1はホスト慣性ナビゲーションシステムにより供給さ
れる。DS1は、慣性ナビゲーションシステムの全てのジャイロをサンプリング
すべき時点を表わす。モジュラジャイロシステムの待ち時間を排除するために、
サンプル時間を予測する必要がある。サンプルストローブDS1は、さらに、I
NS内部の複数のジャイロを同期させる。
本発明のこの実施例では、マイクロ制御装置100は単一のアナログ/デジタ
ル変換器へと多重化される多数のアナログ入力を有する。2つ以上のアナログ入
力信号をアドレス指定するために単一のA/D変換器を多重使用するには、サン
プリングの時間を適正に決めることが必要である。マイクロプロセッサシステム
は、この実施例においては電気的消去可能プログラム可能読取り専用(「E2P
ROM」)である不揮発性メモリを含む。ディザ周波数やディザ基準角度などの
いくつかのシステムパラメータをシステムのパワーオン後に復元できるように、
それらのシステムパラメータをE2PROMに記憶しておく。別の不揮発性メモ
リ手段も使用できることは当業者には認められるであろう。
始動時初期設定シーケンスにおいては、ディザ駆動部はディザ周波数で方形波
の20パルスでパルス動作される。たとえば、ディザ周波数が500Hzで動作
している場合、20パルスに対してデューティサイクルは0%から100%に変
化する。このサイクル動作はディザモータにその固有共振周波数の近くでエネル
ギーを供給して、ディザモータを始動させる。
次に、本発明に従って構成したディザピックオフ回路の1例の回路図を示す図
2を参照する。1例では、ディザピックオフ装置は少なくとも第1,第2及び第
3のコンデンサ402,406,412と、第1から第7の抵抗器404,40
7,410,414,422,424,426と、第1及び第2の増幅手段40
8,420とを具備する。また、この図では固有キャパシタンスによって象徴さ
れたディザピックオフ244Aも示されている。第1のコンデンサ402は接続
点405で第1の抵抗器404と並列に接続されている。ディザピックオフも、
接続点405に接続されている。第2のコンデンサ406は第1の端子で接続点
405に接続されると共に、他方の端子では第1の増幅器408の非反転入力端
子に接続されている。第1の増幅器408と、抵抗器410,414及び426
と、コンデンサ412とは、ディザピックオフ回路に対して第1の利得係数及び
位相の補償を実行するのに適する構成で接続している。第1の増幅器の出力41
8は、ディザピックオフを表わすほぼ正弦波形の信号416をマイクロ制御装置
100のアナログ/デジタル入力端子に供給する。第2の増幅器420と、抵抗
器422及び424とは、デジタル論理800にあるワンショット810の零交
差入力端子にほぼ方形波の信号430を供給し、最終的にはその信号を制御装置
100に供給するために、周知のように接続、配置されている。信号430もデ
ィザピックオフを表わしており、ディザ周期を計算する基礎となる基本零交差検
出信号を形成する。ワンショット810は最大割込み周波数を1000Hzに制
限し、それにより、始動中の偽割込みをなくす。
次に、本発明の1つの面によって提供されるような直接デジタルディザ駆動回
路500の一実施例の回路図を示す図3を参照する。直接デジタルディザ駆動部
500は第1から第6のコンデンサ502,506,509,514,522及
び534と、第1から第9の抵抗器504,508,510,511,512,
518,519,532及び542と、第1から第3のトランジスタ520,5
28及び530と、ダイオード524と、増幅器516とを含む。
第1のコンデンサ502は第1の端子で制御装置100のパルス幅変調出力端
子501に接続されている。第1のコンデンサ502は第2の端子では第1の抵
抗器504の第1の端子に接続されている。抵抗器504の第2の端子は第2の
コンデンサ506及び第2の抵抗器508の第1の端子に接続されている。抵抗
器508の第2の端子は第3の抵抗器511と第3のコンデンサ509の第1の
端子に接続されている。第3の抵抗器511の第2の端子は第4のコンデンサ5
14及び第4の抵抗器512の第1の端子並びに増幅器516の非反転入力端子
及び抵抗器510に接続されている。増幅器516の出力端子は抵抗器分圧器の
第6の抵抗器518及び第7の抵抗器519を介して、第1のトランジスタ52
0のベースに接続されている。第5のコンデンサ522は増幅器516に対して
補償キャパシタンスとして作用して、位相マージンを増加させる。コンデンサ5
14の第2の端子はトランジスタ520のコレクタ及び第3のトランジスタ53
0のベースに接続されると共に、第8の抵抗器532の第1の端子に接続されて
いる。第3のトランジスタ530のコレクタは第8の抵抗器532の第2の端子
と、本発明のこの実施例では約300ボルトであると有利であろう電圧源とに接
続している。
第3のトランジスタ530のエミッタは第2のトランジスタ528のベースに
接続され、このトランジスタ528のコレクタが電圧源に接続されて、トランジ
スタ530及び528はダーリントン対を形成している。ダイオード524はそ
のダーリントン対と並列に接続する低電圧ダイオードであり、不感帯を形成する
。第4の抵抗器512の第2の端子は第6のコンデンサ534の第1の端子と、
第3のトランジスタ528のエミッタとに接続されている。コンデンサ534は
トランジスタ528の出力を150ボルトだけレベルシフトするために使用され
る。駆動信号は534を介して第9の抵抗器542にAC結合すると共に、レー
ザージャイロブロック200にあるディザモータ244BとにAC結合している
。抵抗器542は零ボルトのDC平均をディザモータに供給する。
本発明の一実施例では、第1から第3のトランジスタはアメリカ合衆国のMo
torola社から入手可能であるモデルタイプMJD50のNPNトランジス
タであると有利であろう。増幅器は合衆国、マサチューセッツ州のAnalog
Devicesから入手可能であるモデルOP−97などのバイポーラ演算増
幅器であると有利であろう。素子の値の例のいくつかを図3に示す。制御装置1
00はIntel Corporationのモデル80C19KCのマイクロ
制御装置又はそれと同等の装置であると有利であろう。
動作に際して、この図示した実施例における本発明の直接デジタルディザ駆動
部は、制御装置100からの5ボルトパルス幅変調デジタル信号を変換器を使用
せずにアナログ300ボルトピークツーピーク信号に直接に変換する回路である
。従来より、変換器は信頼性に欠けることがわかっており、約500Hz程度の
低周波数でディザモータ容量性負荷を駆動するときの飽和を回避するためには、
コアサイズを大きくする必要がある。制御装置100からのパルス幅変調出力5
01Bは、12MHzの水晶104から取り出され且つ0%から100%PWM
までの512段階の分解能を有する制御装置からの5ボルトのパルス幅変調(P
WM)信号であると有利であろう。PWM信号はデジタル/アナログ変換のため
の手段としてのみ使用されるものであり、ディザ周波数でパルス幅変調する方式
とこれを混同すべきではない。
図3に示す本発明の実施例においては、典型的なディザモータ負荷である5.
5nF負荷を500arcsecのピークツーピーク振幅及び4arcsecのRMSランダ
ムノイズをもって駆動する場合に、直接デジタルディザ駆動回路は変圧器構造が
要求する750mWとは対照的に300mW未満しか要求しない。典型的なレー
ザージャイロシステムでは、4arcsecは約1sigmaの標準偏差と等価である。本
発明の回路装置の効率は、PWM23.5KHz信号をフィルタリングし、しか
も、200マイクロ秒未満の立ち上がり時間と立ち下がり時間を与える約(50
0Hz×23.5KHz)1/2=3.6KHzの伝達関数をもつ3つの低域極を
配置することによって実現される。駆動周波数をfとするとき、容量性負荷を駆
動するために要求される電圧は(V2×f)に比例するので、電力を浪費しない
ために負荷からのPWM信号をフィルタリングすることは重要である。
駆動の効率は、ディザサイクルごとにPWM値を2回しか変化させない制御装
置によってさらに向上する。1回目の変化はディザピックオフの正のピークで起
こり、2度目の変化は負のピークで起こる。5.5nFを500Hz、300ボ
ルト(全振幅)で駆動するために要求される理論上の電力は式:
P=2f(1/2CV2)=272mW
により与えられる。本発明の一実施例に関わるAC電力はこの理論上の限界に近
い。DCバイアス電力は約81mWである。
本発明の別の面はPNPトランジスタを含まず、全てがNPNトランジスタで
ある単一電力源構造を含む。NPNトランジスタは下記のパラメータをもつ表面
実装DPAKにおいて利用可能である:
VCEO=400VDC及びVCB=500VDC
ダイオード524は、トランジスタ520及び528が同時にターンオンする
のを防止するように不感帯を形成する。不感帯は電力源における電流スパイクを
排除すると共に、さらに効率を向上させる。
立ち上がり時及び立ち下がり時の遷移中の安定性を向上させるために、第4の
コンデンサ514は出力端子でトランジスタ528のエミッタではなく、トラン
ジスタ530のベースに接続している。本発明の一実施例では、第5の抵抗器5
12は出力のDC動作点をトランジスタ528のエミッタで約+150ボルトに
設定する。次に、トランジスタ528のエミッタにおける出力をコンデンサ53
4を結合することによって最終出力540へとレベルシフトする。この構成では
、50%デューティサイクルのPWM信号入力は出力540における0ボルト出
力に相当する。0%デューティサイクルのPWM信号は約+130ボルトの54
0の出力に相当する。100%デューティサイクルのPWM信号は出力の約−1
30ボルトに相当する。図示した例においては、レーザージャイロのパワーアッ
プ中、結合コンデンサ534を充電するための時間は約0.7秒である。
本発明の別の面では、入力は第1のコンデンサ502によりAC結合されて、
低周波数成分をもたない対称駆動を実行させる。レーザージャイロの始動中、コ
ンデンサ502を所定のDCレベルまで充電するために、制御装置は約14ms
にわたり50%デューティサイクルのPWM信号を出力する。先に述べた通り、
始動時初期設定シーケンスは、ディザ駆動部を方形波をもってディザ周波数で2
0パルスにわたりパルス動作させることによって始まる。ディザ周波数が500
Hzであるとき、20パルスに対してデューティサイクルは0%から100%ま
で変化する。このサイクル動作はディザモータにその固有共振周波数の付近でエ
ネルギーを供給して、ディザモータを始動させる。
次に、本発明の1つの面により提供されるようなディザ駆動回路の代替実施例
の詳細な回路図を示す図4を参照する。図4のディザ駆動回路は一次巻線460
,464と、二次巻線462とを有する変圧器から構成されている。第1のダイ
オード454は公称では±15ボルトであっても良い電圧源480に巻線460
を介して接続している。同様に、第2のダイオード456は巻線464を介して
電圧源480に接続している。二次巻線462は第1の脚部でレーザージャイロ
ブロック200にあるディザ駆動部244Bに結合している。一対のトランジス
タ450,452は第1及び第2のPWM信号470,472によりプッシュプ
ル方式で駆動される。トランジスタ450,452はMOSFET型デバイス又
はそれと同等のデバイスであると有利であろう。
次に、ディザピックオフ244Aからディザモータ244Bに至るディザピッ
クオフ信号245Aを示す本発明の直接デジタルディザ駆動の方法及び装置の高
レベル概略図を示す図5Aを参照する。図5Aは、ディザ変位を表わす電圧20
5をジャイロ200の慣性回転を表わすレーザージャイロカウントに利得変換す
るディザ駆動部の一実施例を表わす。その後の全ての処理はPWM信号501の
発生までのカウントを使用して実行される。
ディザピックオフ244Aは、ディザピックオフ信号245Aをフィルタ20
2に供給し、フィルタ202はそのディザピックオフ信号245Aを調整して、
調整ピックオフ信号203を供給する。ピックオフ信号203を増幅器204に
より増幅して、10ビットA/D変換器206へ送る。A/D変換器206は調
整増幅ディザピックオフ信号205をディザピックオフ信号245Aの電圧を表
わすデジタル信号207Aへと変換処理する。次に、デジタル信号207Aを増
幅器215によりジャイロブロック200の角変位を表わすカウント値209A
に利得変換する。
図5Aの実施例では、デジタル信号207Aを所定の定数Kに乗算することに
よってカウントに変換する。1カウントは1arcsecの角変位とほぼ等しい。定数
Kはカウント/ボルト単位である。Kは、等価デジタルボルトを求めるためにデ
ィザストリッパで使用されるのと同じ定数である。定数Kはディザストリッパに
よって絶えず更新されており、ディザピックオフアナログボルトと等価デジタル
読取りカウントとの直接校正相関を表わす。
デジタルカウントとして表現される所定の基準変位ディザ角度213はEEP
ROM102に記憶される。
次に、デジタル信号は、信号にランダムノイズ211を導入するランダムノイ
ズインジェクタ210に信号を供給するデジタル利得増幅器212へと進む。レ
ーザーが動的ロックイン効果を受けるのを阻止するためにランダムノイズ211
が与えられる。そこで、信号はパルス幅変調リミタ214に入力し、リミタ21
4はパルス幅変調器216に信号215を供給する。PWM信号は基準値とブロ
ックの測定変位値との差によって決まる。直接ディザ駆動部は図3にさらに詳細
に示されている。
次に、ディザピックオフ244Aからディザモータ244Bに至るディザピッ
クオフ信号245Aの流れを示す本発明の直接デジタルディザ駆動の方法及び装
置の別の高レベル概略図を示す図5Bを参照する。図5Bは、全ての処理がPW
M信号501の発生までのボルトを使用して実行されるようなディザ駆動部の一
実施例を表わす。
図5Bに示す本発明の代替実施例においては、A/D変換器206の出力は比
較器208に供給されて、図5Aの場合のようなカウントではなく、電圧を表わ
す信号を発生する。
デジタルカウントとして表現される所定の基準変位ディザ角度213はEEP
ROM102に記憶されている。図5Bの実施例では、基準変位213を所定の
定数Kの逆数と乗算することによりデジタルボルトに変換する。図5Bにおける
処理の残る部分は図5Aの場合と同様に進行する。
次に、ディザピックオフ244Aからディザモータ244BのLeg1 47
0及びLeg2 472に至るディザピックオフ信号245Aの流れを示す本発
明の直接デジタルディザ駆動の方法及び装置の別の高レベル概略図を示す図5C
を参照する。図5Aによる本発明の方法及び装置の場合と同様に、図5Cは、デ
ィザ変位を表わす電圧205をジャイロ200の慣性回転を表わすレーザージャ
イロカウントに利得変換するディザ駆動部の一実施例を表わしている。後続する
全ての処理は、高速出力内容参照可能メモリ(HSO CAM)駆動信号470
及び472の発生までのカウントを使用して実行される。
図5Cでも、デジタル信号はパルス幅変調リミタ214に信号を供給するデジ
タル利得増幅器212へと進み、そこで、リミタ214はデジタルディザ駆動部
のHSO CAM駆動部216にパルス幅変調信号215を供給する。上述の実
施例の場合と同じように、PWM信号は基準値とブロックの測定変位値との差に
よって決まる。
本発明のこの実施例における高速出力論理は、INTEL CORPORAT
ION製造の80C196 KCマイクロプロセッサのHSOユニットによって
形成されている。高速出力論理は所定の時点で事象をトリガする。事象はHSO
指令レジスタ及びHSO時間レジスタと呼ばれるものに指令を書込むことにより
調整される。A/D変化、タイマのリセット、ソフトウェアフラグのリセット及
び高速出力線の切替えを含む高速出力によって異なる事象が可能である。INT
EL CORPORATIONの80C196 KC User’s Guid
eを参照すると、高速出力論理のさらに詳細な知識が得られる。詳細には、HS
O指令レジスタを説明している80C196 KC User’s Guide
の図10−1を参照のこと。直接ディザ駆動部への入力はHSO CAM駆動部
又は80C196 KCマイクロ制御装置から発生される。直接ディザ駆動部5
00の構造は図3に関連してさらに詳細に示されている。
次に、高速出力CAM駆動部216は470でLeg1を駆動し且つ472で
Leg2を駆動するためにディザ信号を供給する。
図5Dは、全ての処理がHSO CAM駆動信号470及び472の発生まで
の電圧を使用して実行されるようなディザ駆動部の一実施例を表わす。
次に、本発明の方法の詳細な割込みタイミング図を示す図6を参照する。本発
明の一実施例における直接駆動ディザシステムは、割込みをトリガするために、
図2の零交差検出器の出力430を使用する。図2の信号430はタイミングク
ロックに類似する波形列を供給する。図6には、その波形列の詳細を一群の方形
波604として示してある。波形列は時間602の関数として、信号線430の
出力として示されている。信号604はジャイロブロック位置信号620により
指示される、ジャイロブロック200がその循環ディザ運動の中で零点と交差し
た時点を指示する。零交差点は618A,618B,618C及び618Dによ
り指示されている。発生した割込みは割込み610A,610B,610C及び
610Dとして示されている。割込みは、点605A,605B,605C及び
605Dにおける出力信号430のローからハイへの遷移に対応するブロック2
00の零交差618A,618B,618C及び618Dで発生する。
ローからハイへの遷移が起こる時点に注目することによって、ディザピックオ
フ244Aの周波数を計算できる。図6において、t0は割込み610Aを発生
する遷移605Aの発生を表わし、t1は割込み610Bを発生する遷移605
Bの発生を表わし、t2は割込み610Cを発生する遷移605Cの発生を表わ
し、t3は割込み610Dを発生する遷移605Dの発生を表わす。割込みごと
のこの1組の情報によって、時間差(t1−t0)を1サイクルに分割する。すな
わち、1/(t1−t0)を求めることによりディザの周波数を計算できる。2つ
以上の割込みの間のこの1組の情報によって、割込み610A及び610Dの時
間差(t3−t0)を3サイクルに分割する、すなわち、3/(t3−t0)を求め
ることによりディザの周波数を計算できる。
本発明の直接ディザの方法の一実施例では、90°と270°のブロックサイ
クル位置の場所を測定することが必要である。90°の位置は図6には点622
A,622B及び622Cとして示されている。270°の位置は図6には点6
24A,624B及び624Cとして示されている。
次に、ディザサイクルの270°と90°の交差点を確定するための本発明の
直接デジタルディザ駆動装置の方法を示す図7を参照する。方法は、まず、零交
差検出器出力430により発生される割込みを示すプロセスブロック902をも
って始まる。零交差検出器は先の図である図2及び図6には信号604として示
されている。零交差検出器からの割込み信号は、本発明の方法の一実施例におい
ては、T2CAP割込みとして知られている。次に、プロセスは904に進み、
そこでT2CAP割込みサービスルーチンを実行する。T2CAP割込みサービ
スルーチンは後続するプロセス流れ図の中で説明されている。906では、T2
CAP割込みが発生した時間を把握する。次にプロセスは908に進み、割込み
の時間Tnを一時レジスタに記憶する。次にプロセスは910に進み、最前の割
込みから時間の変化を計算する。このプロセスが実行される最初の時間、初期時
間を近似する。新たな時間、デルタTは現在時間から最前の割込み時間を減じた
差であると確定される。次にプロセスは912に進み、2回の割込みの間の経過
時間、すなわち、時間差を4で除算する。この手続きは、割込み間の時間差に関
わる直角位相を確定するために実行される。この数はデジタルシステムの分解能
として正確であり、ディザサイクルの零交差と零交差との間の時間の量を表わす
。この量自体はレーザージャイロブロックの実際のディザの周波数を表わす。
次にプロセス914へ進み、位相進み補償を計算する。位相進み補償は図7に
示すT2CAP割込みの中で確定される。位相進みはデルタTを定数KPLで除算
したものとして定義されている。デルタTはレーザーブロックが1サイクルだけ
ディザするのに要する時間の量に相当する。すなわち、デルタTは360°に等
しい。定数KPLはディザサイクルと、アナログ遅延とに基づく所定の値である。
たとえば、所定の定数KPLが32に等しい場合、位相進みは360°/32、す
なわち、11.25°となるであろう。TPLとして定義される位相進み時間の量
は、デルタTとサイクルの位相進み比率と乗算することによって計算されるであ
ろう。すなわち、TPL=デルタT*(11.25°/360°)となるであろう
。位相進みの目的は、所望の実際のディザ駆動信号と一致するディザ駆動信号を
供給することである。この位相進みはディザ駆動部の処理回路における関連遅延
と、ソフトウェア処理における関連遅延とを予測するものである。第1の直角位
相Q1は90°の位置でのレーザーブロックの実際の変位に相当する。位相進み
直角位相Q1PLは、図5に示す高速出力ディザ駆動CAM216に関わる実際の
サンプル時間を表わすQ1−TPLとして定義されている。図7のプロセスは次に
916へ進み、中間点Q2を第1の直角位相の和(Q1+Q1)の2倍であると
して確定する。次にプロセスは918へ進み、第3の直角位相Q3をQ2+Q1PL
であるとして確定する。次に、図7のT2CAP割込みは必要に応じてバック
グラウンドA/D変換の有無を検査する。バックグラウンドA/D変換の必要性
は、現在A/D変換の使用を解決するために図12に示す本発明の実行順序指定
方法によって使用されるソフトウェアタイマフラグ及び割込みをスケジューリン
グする。ソフトウェアタイマフラグと割込みは高速出力論理を使用してスケジュ
ーリングされる。次にプロセスはステップ919へ進み、ディザ駆動及びディザ
ストリッパに関わるA/D変換をバックグラウンドA/D変換と共に実行順序指
定
する。プロセス919は図8に関連して詳細に説明される。プロセスは920で
終了し、図9に示す戻りモジュラジャイロモニタ制御ループに戻る。
図9に示すモニタ制御ループ390は、デジタルモジュラジャイロ10に関わ
る主プロセス実行ループである。モニタ制御ループは、モニタ制御ループのプロ
セスを実行する前に、ディザストリッパA/D変換がステップ300で完了する
のを待つ。セットされた場合にA/D変換が完了したことを指示する変換完了フ
ラグは本発明の装置に含まれている。モニタ制御ループ390は、まず、ディザ
ストリッパアルゴリズム302の実行を示している。温度バイアスドリフト及び
エージに関わる回転慣性ナビゲーションデータの補償は次のステップ304で起
こる。306では、モニタ制御ループ390はシステムのI/Oセットアップを
実行する。次にプロセスは308のバイアスドリフト改善及びランダムドリフト
改善ステップへと進む。次にプロセスは310へと進み、モジュラジャイロに関
して外部システムにより与えられる指令を処理する。プロセスは312で組込み
試験機能を実行し、プロセス314ではレーザーモード限界を検査する。次に、
モニタ制御ループ390は、モジュラジャイロ10がシャットダウンされるまで
この一連のプロセスを繰り返す。
次に、A/Dバックグラウンド変換をスケジューリングする方法を示す図15
を参照する。A/Dバックグラウンド変換のスケジューリングは、待ち行列でス
ケジューリングできる所定の1組のA/D変換事象を有するハードウェアシステ
ムにおいて起こる。A/D変化の回数はあらかじめ定められている。本発明の一
実施例では、待ち行列の中に7回のA/D変換が入っている。図9に示すモニタ
制御ループによって、それらのA/D変換を実行順序指定するプロセスは、A/
Dバックグラウンド変換完了フラグを検査するステップ870で最初に開始され
る。次にプロセスは872へ進み、変換完了フラグがセットされているか否かを
知るためにフラグを検査する。フラグがセットされていなければ、プロセスはル
ーチンから出るように進み、ステップ870でモニタ制御ループに戻る。この場
合、最前にスケジューリングされたA/D変換に関わるA/D変換はまだ実行さ
れていないので、A/D変換を実行することはできない。変換完了フラグがセッ
トされていれば、プロセスはステップ874へと進み、現在バックグラウンドA
/D変換をバックグラウンド変換A/Dレジスタに記憶する。これは現在バック
グラウンドA/D変換を、温度の測定、PLC監視などの別のルーチンによって
セットアップされる機能と関連づける。次にプロセスはステップ878へと進み
、バックグラウンドA/D変換マルチプレクサポインタを検査する。次にプロセ
スは880へと進み、ポインタを検査した後に実行すべきことを確定する。ポイ
ンタが最前のバックグラウンド機能を指示しているならば、ステップ882にお
いて第1の機能を指示するように待ち行列をリセットする。ポインタが最前のバ
ックグラウンド機能でない場合には、プロセスは884で次のバックグラウンド
機能ポインタに増分する。いずれの場合にも、プロセスはステップ886へと進
み、待ち行列の中の別のバックグラウンド変換をスケジューリングする。次にプ
ロセスは876でモニタ制御ループへと出る。
次に、本発明の方法のデジタルディザ駆動アプリケーションにおける複数のア
ナログ信号の間で単一のアナログ/デジタル変換器を実行順序指定する方法を示
す図8を参照する。図8は、デジタルモジュラジャイロ10がディザストリッパ
変換時間702をステップ702へ転送するプロセス流れの図を示している。変
換時間HsiTime 1は、1991年12月11日出願、名称Laser
GYRO DITHER STRIPPERのU.S.Serial No.0
7/805,122に基づく出願人の同時係属PCT出願の中に説明されている
ディザストリッパプロセスから計算される。
次に、プロセスはプロセス702において送られて来た2つの値から計算され
る期待ストリッパ時間を計算すべく流れる。第1の値は、ディザストリッパ変換
時間の始まりであるHsiTime 1であり、HsiDeltaもプロセス7
02を経て外部システムから送られて来る。期待ディザストリッパサンプル時間
はHsiTime 1とHsiDeltaの和である。この時間をHsiTim
e 2という。次にプロセスは706へと進み、ディザ駆動に関わるA/D変換
器をロックアウトするために、HsiTime 2を中心としてウィンドウを作
成する。これは、ディザ駆動A/D変換とディザストリッパA/D変換が同時に
起こった場合にそれらが妨害し合うのを阻止する。本発明のこの実施例における
A/D変換器は非同期変換器である。A/D変換は、A/D変換をセットアップ
するプロセスに対して非同期的に起こる。プロセスステップ708は、ディザ駆
動に関わるA/D変換がディザストリッパウィンドウの中で起こるか否かを計算
する。次にプロセスはプロセスステップ712又はプロセスステップ710のい
ずれかへ分岐する。プロセスステップ710は、位相補償A/D変換と、ソフト
ウェアタイマフラグをスケジューリングし、特定のディザ駆動に対して割込むた
めに、高速出力内容参照可能メモリ(HSO CAM)をセットアップする。プ
ロセスステップ712は、ソフトウェアタイマフラグをスケジューリングし、既
にスケジューリングされているディザストリッパA/D変換を共用するように特
定のディザ駆動に対して割込むために、HSO CAMをセットアップする。本
発明の方法は、スケジューリングされた時点でどの型のアクションをとるべきか
、ディザストリッパ変換、ディザ駆動変換、ディザストリッパ及びディザ駆動共
用変換、バックグラウンド変換のどれをとるべきかを確定するために、ソフトウ
ェアタイムフラグの状態を検査する。プロセスステップ708は新たなA/D変
換をスケジューリングするか、あるいは、発生するものとスケジューリングされ
ている変換を共用する方法を提供する。本発明の方法において暗示されているの
は、ディザストリッパA/D変換は常に最高の優先順位を有しているためにウィ
ンドウ内の単一のA/D変換がディザ駆動アプリケーションには適切であるとい
う仮定である。プロセス712では、別のルーチン、すなわち、A/D変換が共
用されるディザ駆動ルーチンとディザストリッパルーチンを指示するフラグをセ
ットする。プロセスステップ710では、A/D変換をスケジューリングし、そ
の変換の結果を以下に説明する高速出力論理に関わるマイクロ制御装置100の
中の内容参照可能メモリヘ送信する。A/D変換は先に説明したように位相補償
されている時間Q1及びQ3にスケジューリングされる。次にプロセスは714
へと進み、A/D変換器の実行順序指定は完了した。
次に、ディザピックオフのアナログ/デジタル変換からパルス幅変調駆動信号
を計算する方法を示す図10を参照する。80C196 KCマイクロ制御装置
100で具現化される本発明の方法は、822におけるディザ駆動ルーチンから
のA/D変換割込みを伴ってプロセスブロック821で始まる。起こっているべ
きである読出しカウントで表現されるディザモータの角変位の量である基準変位
をステップ824でメモリから読取る。ステップ825では、ディザ角度基準カ
ウントをディザストリッパ利得調整に基づいてデジタルボルト単位の等価のアナ
ログピックオフ信号に変換する。
次にプロセスは826へと進み、ディザモータ変位における誤差を基準変位か
ら実際の変位を減じたものとして計算する。次にプロセスは828へと進み、計
算した誤差を本発明の一実施例では50である所定の利得係数と乗算する。次に
プロセスは830へと進み、830ではシステムにランダムノイズを導入する。
本発明の一実施例では限定的な意味をもたない1例として、ランダムノイズの分
布はガウス分布である。次にプロセスは832へと進み、レジスタのロールオー
バを回避するために、パルス幅変調信号出力を100%PWMの最大値と、0%
PWMの最小値とに限定する。本発明のこの実施例では、制限値は0%又は10
0%のPWMを表わす0又は255である。次にプロセスはステップ834へと
進み、ディザモータを導入されたランダムノイズによって調整した基準値の中に
入れるために、ディザ駆動部に計算された駆動レベルを与える。次にプロセスは
836で終了する。
次に、直接デジタルディザ駆動部のA/D変換ハンドラの慨略図を示す図11
を参照する。モジュラジャイロでは、A/D変換はディザの直角位相を計算する
ために要求されるようなディザ駆動変換、ディザストリッパ変換及びバックグラ
ウンド変換に対して要求される。図11に示すプロセスは、A/D変換がどのプ
ロセスを要求したかに応じてA/D変換を処理する方法である。その方法はA/
D変換割込みを伴って930で始まる。プロセスブロック932では、A/D変
換の源が934のディザ駆動プロセスから発生するか、936のディザストリッ
パプロセスから発生するか、ディザストリッパ及びディザ駆動プロセス938か
ら発生するか、あるいは、バックグラウンドプロセス940から発生するかを確
定する。ストリッパ及び駆動ステップ938は、ディザ駆動A/D変換がディザ
ストリッパA/D変換ウィンドウの中で起こったことを指示する。ディザストリ
ッパのウィンドウはディザ駆動にも適するので、プロセスは単純なディザストリ
ッピング動作の場合と全く同様にステップ942へと進む。A/D変換を要求す
るデジタル駆動934は946のディザ駆動へ直接に進む。ディザ駆動ルーチン
は図10にさらに詳細に説明されている。
A/D変換が「起こる」ときまでに、そのA/D変換をどのプロセスが要求し
たかは既にわかっている。これは図8に示すT2CAP割込みと、ソフトウェア
タイマ割込みとによってあらかじめ確定されていたのである。
ディザストリッパ、もしくはディザ駆動及びディザストリッパがA/D変換を
要求する場合、プロセスはステップ942へと進み、ストリッパレジスタのA/
D値を読取る。次に、944では、ストリッパ又はストリッパ及び駆動に関わる
最近のA/D変換値がストリッパレジスタにあり且つストリッパ及び駆動により
要求されたことを指示するためにA/D変換完了フラグをセットする。次に、プ
ロセスは駆動又はストリッパ及び駆動のいずれかの場合に946のディザ駆動へ
と進む。バックグラウンドA/D変換の場合には、プロセスは940へと進み、
948でバックグラウンドレジスタからA/D値を取り出し、950ではバック
グラウンド変換について変換完了フラグをセットする。いずれの場合にも、プロ
セスは952で終了する。
次に、ディザ専用変換、共用変換又はバックグラウンド変換のいずれかをスケ
ジューリングするためのソフトウェアタイマ割込みの割込みサービスルーチンを
示す図12を参照する。プロセスは、ステップ1002で特殊関数レジスタから
ソフトウェアタイマフラグを取り出すことにより、1000で始まる。次に、プ
ロセスはソフトウェアタイマフラグがディザ駆動A/D変換についてセットされ
ているか否かを知るために検査する。セットされていれば、プロセスはステップ
1020へ進み、マイクロ制御装置100のスクラッチパッドRAMにあるA/
D優先順位レジスタでディザ駆動A/D変換専用フラグをセットし、ステップ1
022で終了する。ディザ駆動変換が指示されていなければ、プロセスはステッ
プ1006へと進み、プロセスは駆動及びストリッパ変換についてソフトウェア
タイマフラグがセットされているか否かを知るために検査する。セットされてい
れば、プロセスはステップ1018へ進み、マイクロ制御装置100のスクラッ
チパッドRAMにあるA/D優先順位レジスタでディザストリッパ及びディザ駆
動共用A/D変換フラグをセットし、ステップ1022で終了する。共用変換が
指示されていなければ、プロセスはステップ1008へと進み、本発明の方法は
ディザストリッパA/D変換が進行中であるか否かを検査する。図12の方法で
暗示されているのは、共用変換又はディザ駆動変換がなければ、それはバックグ
ラウンド変換でなければならないという条件である。次にプロセスはステップ1
010へと進み、ステップ702で説明したようにHsiTime+HsiDe
ltaとして定義されているウィンドウの中でディザストリッパA/D変換が起
こるか否かを検査する。変換がウィンドウ内で起こるのであれば、プロセスはス
テップ1022で終了する。変換がウィンドウの中で起こらない場合には、プロ
セスはステップ1014へ進んで、バックグラウンド変換が完了するのを待つ。
バックグラウンド変換は指定の期間中に起こり、本発明の一実施例においては、
バックグラウンド変換は20マイクロ秒以内に起こる。次にプロセスはステップ
1016へ進み、変換値をバックグラウンドA/Dレジスタに記憶する。次にプ
ロセスはステップ1022で終了する。バックグラウンドA/D変換プロセスの
完了を待機する状況を図11で説明したように割込み駆動するか、又は図12に
説明するようにポーリングすることが可能であるのは当業者には認められるであ
ろう。
次に、次のシステムサンプルクロックの発生を計算し且つ予測するために使用
される本発明の方法を示す図13を参照する。サンプルクロックを予測すること
の重要性は、外部慣性ナビゲーションシステムが慣性ナビゲーションシステム全
般を通して一様な外部クロックに対し同期される慣性ナビゲーションデータを獲
得しなければならないことによって表わされる。この能力がないと、慣性ナビゲ
ーションデータは非同期的に供給されるので、慣性位置の評価が不正確になると
いう結果を招くであろう。図13のプロセスは、プロセスが最初に初期設定され
るときにプロセスブロック150でカウンタを始動することによって始まる。次
にプロセスはプロセスブロック152へと進み、システムからのサンプルクロッ
クの端を把握し、これはプロセスブロック154で割込みを発生させる。次に、
割込みは割込みループ170と呼ばれるプロセスを開始させる。割込みループは
A/D変換をスケジューリングする。プロセスステップ154で割込みが発生さ
れた割込みの時点で、ステップ150のカウンタからのカウント値を記憶する。
次にプロセスは158へと進み、割込みが発生した最前の時点をメモリから読取
る。次にプロセスは160へと進み、旧割込みと新たな割込みとの時間差を「デ
ルタt」としT計算する。次にプロセスは162へと進み、マイクロプロセッサ
の高速出力でA/D変換をセットアップする。高速出力が発生すべき新たな時間
は「新t」に「デルタt」を加えたものである。次にプロセスは164へと進み
、「旧t」を「新t」と等しくなるようにセットアップし、プロセスはプロセス
152へと戻って、次のサンプルクロックを把握する。図13の方法はシステム
サンプルクロック周期中の変化を動的に補償すると共に、システムサンプルクロ
ックの動きを動的に追跡する。162においては、HSO論理でディザストリッ
パに関わるA/D変換をセットアップする。出願人の同時係属出願のリングレー
ザージャイロ直接ディザ駆動装置の中で説明されているディザ駆動装置によって
もA/D変換162は使用される。
次に、3つのアナログ/デジタル変換を利用してレーザージャイロディザを駆
動するための本発明の方法及び装置を示す図14を参照する。本発明の方法は図
14で説明する装置に適用できるであろうということは当業者には理解されるで
あろう。
この実施例では、第1のA/D変換器1212は、先に説明したディザストリ
ッパ動作について適切に時間限定されるディザピックオフ電圧のデジタル表現を
提供する。ディザストリッパに関わるA/D変換はDS1が活動状態であるとき
に起こらなければならない。マイクロ制御装置100はA/D変換の結果と、エ
ッジトリガ読出しカウンタレジスタ1220の出力1222とを使用して、ディ
ザストリッピング動作を実行する。
第2のA/D変換器1214は、先に説明したディザ駆動動作について適切に
時間限定されるディザピックオフ電圧のデジタル表現を提供する。ディザ駆動に
関わるA/D変換は、零交差検出器820が活動状態であるときに起こらなけれ
ばならない。マイクロ制御装置100はA/D変換の結果1204を使用して、
ディザ駆動動作を実行する。
第3のA/D変換器1216は、温度測定、RIM及びLIM測定、PLC監
視などのバックグラウンドプロセスのデジタル表現を提供する。バックグラウン
ドA/D変換はイネーブル線1218を介してマイクロ制御装置によりイネーブ
ルされる。
本発明を特許法に従うと共に、新規な原理を適用し且つそのような特殊化され
た素子を必要に応じて構成,使用するために必要とされる情報を当業者に提供す
るためにここに相当に詳細に説明した。しかしながら、本発明を特定して異なる
機器や装置により実行できること、及び機器の詳細と動作手続きの双方について
、本発明自体の範囲から逸脱せずに様々な変形を実現できることを理解すべきで
ある。Detailed Description of the Invention Laser gyro direct dither drive The present invention relates generally to laser gyros, and more particularly to methods and apparatus for digitally driving a laser gyro dither motor directly using a microcontroller in a closed loop system. Background of the Invention A laser angular velocity sensor often called a laser gyro is well known. One example of a laser angular velocity sensor is US Pat. No. 4,751,718 issued to Hanse et al., Which is also incorporated herein by reference. Today's laser angular velocity sensors include a thermally stable and mechanically stable laser block with a plurality of cavities formed to surround the void. Mirrors that reflect the laser beam and form a closed loop optical path are arranged at both ends of the cavity. In connection with such sensors, there is an undesirable phenomenon known as lock-in, which has heretofore been recognized in the prior art. The prior art has dealt with the lock-in phenomenon by rotationally oscillating such a sensor, i.e. by dithering. Rotational vibrations are typically supported by dither motors. Conventional dither motors typically have a suspension system that includes, for example, an outer rim, a central hub member, and a plurality of dither motor leads that project radially from the hub member and are coupled between the hub member and the rim. Traditionally, a set of piezoelectric elements that act as actuators have been coupled to a suspension system. When actuated by applying an electrical signal to the piezoelectric element, the suspension system acts as a dither motor, so that the block of sensors angularly vibrates at the natural mechanical resonance frequency of the suspension system. This dither motion is superimposed on the inertial rotation of the sensor in inertial space. Such dither motors may be used in connection with a single laser gyro, or may be used to dither multiple laser gyros. The prior art includes various schemes for recovering dither-free inertial rotation data. Summary of the invention The present invention provides a direct digital dither driving device for a laser gyro. The direct digital drive of the present invention includes a low pass filter having at least three poles, a high pass filter having at least two poles, an output for providing a filtered signal, and an input for connecting a pulse width modulated digital drive signal. And. The direct digital driver further comprises an amplifier coupled at the input side to the output of the low pass filter and amplifying the filtered signal from the low pass filter, the means for driving the dither motor in response to the amplified signal is Active pull-up means coupled to the output, the driving means including means for substantially eliminating current spikes in the power supply signal and providing dead zone operating characteristics to form a highly efficient driver with low power consumption. including. One object of the present invention is to provide a dither motor drive means that provides an output in the range of +150 to -150 volts in response to a pulse width modulated input over the range of 0% duty cycle to 100% duty cycle. Another object of the invention is to provide an improved dither driver circuit that consumes power only during the transitions of the pulse width modulated signal input. Yet another object of the present invention is to provide an improved dither drive circuit that consumes a small amount of power when the capacitive drive load of the dither motor reaches steady state. Other objects, features and advantages of the invention will be apparent to those skilled in the art from the description of the preferred embodiments, the claims and the drawings. In the drawings, the same reference numerals indicate the same elements. Brief description of the drawings FIG. 1 shows a block diagram of one embodiment of a laser gyro employing the novel features of the present invention. FIG. 2 schematically shows a circuit diagram of an example of a dither pickoff circuit constructed according to the present invention. FIG. 3 schematically illustrates a circuit diagram of one embodiment of a direct digital dither driver circuit provided by one aspect of the present invention. FIG. 4 shows a detailed schematic diagram of another embodiment of a dither driver circuit provided in accordance with one aspect of the present invention. FIG. 5 shows a high level schematic block diagram of a direct dither driver used in a laser gyro including a closed loop system. FIG. 6 shows an interrupt timing diagram as a function of the output of the zero-crossing detector. FIG. 7 shows a method for determining the 90 ° and 270 ° intersections of the dither cycle. FIG. 8 shows a schematic diagram of the method and apparatus of the present invention used to order a single analog-to-digital converter among multiple other modular gyro functions. FIG. 9 illustrates a method of monitoring a modular gyro with a monitor control loop. FIG. 10 illustrates a method of processing a dither pickoff signal that has been digitized and converted from the dither pickoff. FIG. 11 shows a schematic diagram of a method of handling A / D conversion when called by any of the driving process, stripper process and background process. FIG. 12 shows a schematic diagram of an interrupt service routine associated with a software timer interrupt. FIG. 13 illustrates the method of the invention used to predict the sample strobe. FIG. 14 illustrates the method of the present invention utilizing multiple analog to digital converters. FIG. 15 illustrates the inventive method for awaiting background analog-to-digital conversion. Description of the preferred embodiment Reference is now made to FIG. 1, which shows a block diagram of one embodiment of a modular laser gyro employing the novel features of the present invention. The present invention will be described by way of examples. Those skilled in the art having the benefit of this disclosure will understand that the examples provided herein are for purposes of illustrating the principles of the invention and not for purposes of limitation. The laser gyro 10 includes a control device 100, a laser gyro block 200, an active current control unit 300, a dither pickoff amplifier 400, a direct digital dither driving unit 500, a path length control (PLC) device 600, and a reading unit 700. , Digital logic 800. In one embodiment, the direct digital dither driver of the present invention is implemented with a microcontroller used as controller 100. The dither driver includes a dither pickoff 244A, a dither pickoff amplifier circuit 400, an A / D converter 110, a controller 100, a PWM1 115 output line 501B, a direct dither driver 500, and a dither motor 204B. It is a closed loop system. The A / D converter 110 may be integral with the controller and may advantageously be a 10-bit A / D converter. The 10-bit A / D converter is described in US patent application Serial No. We show 10-bit accuracy for the dither stripper method and apparatus discussed in further detail in Applicant's co-pending PCT application "LASER GYRO DITHER STRIPPER" based on 07 / 805,122. The controller 100 may advantageously further include a microprocessor 120. The controller 100 has a core of a processor 120 with hardware peripheral support that provides highly reliable, cost effective and highly integrated control functions. Briefly, in operation, the PLG block position represented by pickoff voltage 245A is first amplified by dither pickoff amplifier 400. The amplified dither pickoff signal 501A is sent to the A / D converter 110 and a comparator (not shown), where the comparator produces a square wave 501C, which limits the maximum frequency of the interrupt. Sent to one shot 810 for. One shot 810 is periodically reset at a rate of about 1000 Hz. One shot output interrupts the controller at the positive zero crossing. The dither pickoff and driver method is shown in more detail in FIG. Based on the zero crossings of the laser block positions, the microprocessor calculates the dither period and predicts the sample time. Next, the dither drive waveform shown in more detail in FIG. 6 is sampled by the A / D converter 110 at the negative and positive peaks of the sine wave of the dither signal. This sampling process also provides the 90 degree phase shift required to drive the dither motor 244B. After sampling, the A / D value is compared to the desired gain adjustment displacement reference, the amount is multiplied with the gain factor, random noise is added, and the signal is sent to the pulse width modulator 115. Random noise may advantageously be Gaussian noise. To correct for variations in the pickoff scale factor, the displacement criterion is modified by adjusting the dither stripper gain. The reference displacement may be further adjusted at periodic intervals by a laser gyro direct dither drive system. The operation of the present invention is discussed in further detail below. In one embodiment of the invention, microcontroller 100 comprises an Intel 80C196 KC Microcontroller. The microcontroller 100 includes three pulse width modulators used for various control functions in this embodiment of the invention. The pulse width modulator PWM1 115 is used to control the dither drive circuit. A number of software modules are associated with the default control of the microcontroller 100. The software program is executed by the microprocessor 120 included in the microcontroller 100. A 100% PWM signal corresponds to a -150 volt output, a 50% PWM signal corresponds to a 0 volt output, and a 0% PWM signal corresponds to a +150 volt output. In one embodiment of the invention, the pulse width modulated signal is initially set to 50% duty cycle. Part of the dither driver circuit utilizes the amount of random noise introduced into the driver circuit. The dither driver random number generator is initialized at startup of the control system of the modular gyro 10. The dither driver circuit is further initialized by initializing system variables. The system represents a reference voltage used to calculate the actual displacement of the laser generation system. In the dither driving circuit, the pickoff signal 245A which is an approximation of a sine signal is generated by dither pickoff. The pickoff signal represents the angular displacement. The reference peak angle value is compared with the peak of the sine pickoff signal to determine the difference value that defines the error in the dither driver. Then, during system power up, the actual reference voltage is initialized. These reference values are stored in the EEPROM 102 and represent the voltage to displacement conversion. In one embodiment of the present invention, the dither driver requires 200 milliseconds for initialization. The dither drive is started simultaneously with the laser or slightly prior to the laser. In the embodiment of FIG. 1, the microcontroller 100 has a first timer and a second timer. The first timer is used for the sampling function. The second timer is used for the dither driving function and the dither stripping function. Both timers need to be synchronized. The onboard high speed output logic of the microcontroller 100 synchronizes timers to perform functions such as A / D conversion during the dither stripping function. The onboard high speed input logic keeps track of external events occurring in real time and stores the count value of the first timer in the FIFO register. As a result, the microcontroller 100 can individually and asynchronously grasp the external event. Sample strobe DS 1 Is provided by the host inertial navigation system. DS 1 Represents the time at which all gyros of the inertial navigation system should be sampled. To eliminate latency in modular gyro systems, sample time needs to be estimated. Sample strobe DS 1 Also synchronizes the gyros inside the INS. In this embodiment of the invention, microcontroller 100 has multiple analog inputs that are multiplexed into a single analog to digital converter. Multiplexing a single A / D converter to address more than one analog input signal requires proper sampling time. The microprocessor system is electrically erasable programmable read-only ("E" in this embodiment). 2 Non-volatile memory, which is a PROM "). To allow some system parameters such as dither frequency and dither reference angle to be restored after the system is powered on, E 2 Store in PROM. Those skilled in the art will recognize that other non-volatile memory means may be used. In the startup initialization sequence, the dither driver is pulsed with 20 square wave pulses at the dither frequency. For example, when operating at a dither frequency of 500 Hz, the duty cycle changes from 0% to 100% for 20 pulses. This cycling action supplies energy to the dither motor near its natural resonant frequency to start the dither motor. Reference is now made to FIG. 2 which shows a circuit diagram of an example of a dither pickoff circuit constructed according to the present invention. In one example, the dither pick-off device includes at least first, second and third capacitors 402, 406, 412 and first to seventh resistors 404, 407, 410, 414, 422, 424, 426, The first and second amplifying means 408 and 420 are provided. Also shown in this figure is the dither pickoff 244A symbolized by the intrinsic capacitance. The first capacitor 402 is connected in parallel with the first resistor 404 at a connection point 405. The dither pickoff is also connected to the connection point 405. The second capacitor 406 is connected to the connection point 405 at the first terminal and is connected to the non-inverting input terminal of the first amplifier 408 at the other terminal. The first amplifier 408, resistors 410, 414 and 426, and capacitor 412 are connected in a configuration suitable for performing first gain factor and phase compensation for the dither pickoff circuit. The output 418 of the first amplifier provides a substantially sinusoidal signal 416 representing the dither pickoff to the analog / digital input terminal of the microcontroller 100. The second amplifier 420 and the resistors 422 and 424 provide a substantially square wave signal 430 to the zero-crossing input terminal of the one-shot 810 in the digital logic 800 and ultimately to the controller 100. It is connected and arranged in a known manner for supplying. Signal 430 also represents dither pickoff and forms the basic zero crossing detection signal upon which the dither period is calculated. One shot 810 limits the maximum interrupt frequency to 1000 Hz, thereby eliminating false interrupts during startup. Reference is now made to FIG. 3, which shows a schematic diagram of one embodiment of a direct digital dither driver circuit 500 as provided by one aspect of the present invention. The direct digital dither driver 500 includes first to sixth capacitors 502, 506, 509, 514, 522 and 534 and first to ninth resistors 504, 508, 510, 511, 512, 518, 519, 532. And 542, first to third transistors 520, 528 and 530, diode 524 and amplifier 516. The first capacitor 502 is connected at its first terminal to the pulse width modulation output terminal 501 of the controller 100. The first capacitor 502 is connected at the second terminal to the first terminal of the first resistor 504. The second terminal of the resistor 504 is connected to the second capacitor 506 and the first terminal of the second resistor 508. The second terminal of the resistor 508 is connected to the third resistor 511 and the first terminal of the third capacitor 509. The second terminal of the third resistor 511 is connected to the first terminals of the fourth capacitor 514 and the fourth resistor 512, the non-inverting input terminal of the amplifier 516 and the resistor 510. The output terminal of the amplifier 516 is connected to the base of the first transistor 520 through the sixth resistor 518 and the seventh resistor 519 of the resistor divider. The fifth capacitor 522 acts as a compensation capacitance for the amplifier 516, increasing the phase margin. The second terminal of the capacitor 514 is connected to the collector of the transistor 520 and the base of the third transistor 530 as well as to the first terminal of the eighth resistor 532. The collector of the third transistor 530 is connected to the second terminal of the eighth resistor 532 and to a voltage source that would be about 300 volts in this embodiment of the invention. The emitter of the third transistor 530 is connected to the base of the second transistor 528, the collector of this transistor 528 is connected to the voltage source, and the transistors 530 and 528 form a Darlington pair. The diode 524 is a low voltage diode connected in parallel with the Darlington pair and forms a dead zone. The second terminal of the fourth resistor 512 is connected to the first terminal of the sixth capacitor 534 and the emitter of the third transistor 528. Capacitor 534 is used to level shift the output of transistor 528 by 150 volts. The drive signal is AC coupled to the ninth resistor 542 via 534 and is also AC coupled to the dither motor 244B in the laser gyro block 200. Resistor 542 provides a zero volt DC average to the dither motor. In one embodiment of the invention, the first to third transistors may advantageously be model type MJD50 NPN transistors available from Motorola, Inc., USA. The amplifier may advantageously be a bipolar operational amplifier such as the model OP-97 available from Analog Devices, Massachusetts, USA. Some examples of element values are shown in FIG. The controller 100 may advantageously be an Intel Corporation model 80C19KC microcontroller or equivalent. In operation, the direct digital dither driver of the present invention in this illustrated embodiment directly converts a 5 volt pulse width modulated digital signal from controller 100 to an analog 300 volt peak to peak signal without the use of a converter. It is a circuit to do. Conventionally, converters have been found to be unreliable, and it is necessary to increase the core size to avoid saturation when driving a dither motor capacitive load at a low frequency of about 500 Hz. The pulse width modulated output 501B from the controller 100 is taken from the 12 MHz crystal 104 and has a 5 volt pulse width modulated (P WM) signal from the controller with 512 steps of resolution from 0% to 100% PWM. Would be advantageous. The PWM signal is used only as a means for digital / analog conversion and should not be confused with the method of pulse width modulation at the dither frequency. In the embodiment of the invention shown in FIG. 3, a typical dither motor load is 5. When driving a 5 nF load with a peak-to-peak amplitude of 500 arcsec and RMS random noise of 4 arcsec, the direct digital dither drive circuit requires less than 300 mW as opposed to 750 mW required by the transformer structure. In a typical laser gyro system, 4 arcsec is equivalent to a standard deviation of about 1 sigma. The efficiency of the circuit device of the present invention is about (500 Hz × 23.5 KHz) which filters the PWM 23.5 KHz signal and gives rise and fall times of less than 200 microseconds. 1/2 = 3.6 KHz by implementing three low-pass poles with a transfer function. When the drive frequency is f, the voltage required to drive the capacitive load is (V 2 Since it is proportional to xf), it is important to filter the PWM signal from the load in order not to waste power. The efficiency of the drive is further improved by the controller changing the PWM value only twice per dither cycle. The first change occurs at the positive peak of dither pickoff and the second change occurs at the negative peak. The theoretical power required to drive a 5.5 nF at 500 Hz, 300 volts (full amplitude) is the formula: P = 2f (1/2 CV 2 ) = 272 mW. The AC power associated with one embodiment of the present invention is close to this theoretical limit. The DC bias power is about 81 mW. Another aspect of the invention does not include PNP transistors, but includes a single power source structure that is all NPN transistors. NPN transistors are available in surface mount DPAK with the following parameters: V CEO = 400 VDC and V CB = 500 VDC diode 524 forms a dead band to prevent transistors 520 and 528 from turning on at the same time. The dead band eliminates current spikes in the power source and further improves efficiency. To improve stability during the rising and falling transitions, the fourth capacitor 514 is connected at the output terminal to the base of transistor 530 rather than the emitter of transistor 528. In one embodiment of the present invention, fifth resistor 512 sets the DC operating point of the output at the emitter of transistor 528 at approximately +150 volts. The output at the emitter of transistor 528 is then level shifted to final output 540 by coupling capacitor 534. In this configuration, a 50% duty cycle PWM signal input corresponds to a 0 volt output at output 540. A 0% duty cycle PWM signal corresponds to an output of 540 at approximately +130 volts. A 100% duty cycle PWM signal corresponds to about -130 volts of output. In the illustrated example, during power up of the laser gyro, the time to charge the coupling capacitor 534 is approximately 0.7 seconds. In another aspect of the invention, the inputs are AC coupled by the first capacitor 502 to perform a symmetrical drive with no low frequency components. During start-up of the laser gyro, the controller outputs a 50% duty cycle PWM signal for about 14 ms to charge the capacitor 502 to a predetermined DC level. As mentioned earlier, the start-up initialization sequence begins by pulsing the dither driver with a square wave for 20 pulses at the dither frequency. The duty cycle varies from 0% to 100% for 20 pulses when the dither frequency is 500 Hz. This cycling action supplies energy to the dither motor near its natural resonant frequency to start the dither motor. Reference is now made to FIG. 4, which shows a detailed schematic diagram of an alternative embodiment of a dither driver circuit as provided by one aspect of the present invention. The dither drive circuit of FIG. 4 is composed of a transformer having primary windings 460 and 464 and a secondary winding 462. The first diode 454 is connected via a winding 460 to a voltage source 480, which may be nominally ± 15 volts. Similarly, the second diode 456 is connected to the voltage source 480 via the winding 464. The secondary winding 462 is coupled to the dither driver 244B on the laser gyro block 200 at the first leg. The pair of transistors 450 and 452 are driven by the push-pull method by the first and second PWM signals 470 and 472. Transistors 450, 452 may advantageously be MOSFET type devices or equivalent devices. Reference is now made to FIG. 5A, which shows a high level schematic diagram of the method and apparatus for direct digital dither drive of the present invention showing the dither pickoff signal 245A from dither pickoff 244A to dither motor 244B. FIG. 5A illustrates one embodiment of a dither driver that gain converts a voltage 205 representing dither displacement into a laser gyro count representing inertial rotation of the gyro 200. All subsequent processing is performed using the count up to the generation of PWM signal 501. The dither pickoff 244A provides the dither pickoff signal 245A to the filter 202, and the filter 202 conditions the dither pickoff signal 245A to provide the adjusted pickoff signal 203. The pickoff signal 203 is amplified by the amplifier 204 and sent to the 10-bit A / D converter 206. The A / D converter 206 converts the adjusted amplified dither pickoff signal 205 into a digital signal 207A representing the voltage of the dither pickoff signal 245A. Next, the digital signal 207A is gain-converted by the amplifier 215 into a count value 209A representing the angular displacement of the gyro block 200. In the embodiment of FIG. 5A, the digital signal 207A is converted into a count by multiplying a predetermined constant K. One count is almost equal to the angular displacement of 1 arcsec. The constant K is in units of count / volt. K is the same constant used in the dither stripper to find the equivalent digital volt. The constant K is constantly updated by the dither stripper and represents the direct calibration correlation between the dither pickoff analog volt and the equivalent digital read count. The predetermined reference displacement dither angle 213, represented as a digital count, is stored in EEP ROM 102. The digital signal then proceeds to a digital gain amplifier 212 which provides the signal to a random noise injector 210 which introduces random noise 211 into the signal. Random noise 211 is provided to prevent the laser from undergoing the dynamic lock-in effect. Therefore, the signal is input to the pulse width modulation limiter 214, and the limiter 214 supplies the signal 215 to the pulse width modulator 216. The PWM signal is determined by the difference between the reference value and the measured displacement value of the block. The direct dither driver is shown in more detail in FIG. Reference is now made to FIG. 5B, which shows another high level schematic diagram of the method and apparatus for direct digital dither driving of the present invention showing the flow of dither pickoff signal 245A from dither pickoff 244A to dither motor 244B. FIG. 5B represents one embodiment of the dither driver such that all processing is performed using the volts up to the generation of PWM signal 501. In the alternative embodiment of the invention shown in FIG. 5B, the output of A / D converter 206 is provided to comparator 208 to generate a signal representing voltage rather than counting as in the case of FIG. 5A. The predetermined reference displacement dither angle 213 expressed as a digital count is stored in the EEP ROM 102. In the embodiment of FIG. 5B, the reference displacement 213 is converted into a digital volt by multiplying it by the reciprocal of a predetermined constant K. The remaining portion of the processing in FIG. 5B proceeds in the same way as in the case of FIG. 5A. Reference is now made to FIG. 5C, which shows another high level schematic diagram of the method and apparatus for direct digital dither driving of the present invention showing the flow of the dither pickoff signal 245A from the dither pickoff 244A to the Leg1 470 and Leg2 472 of the dither motor 244B. To do. Similar to the method and apparatus of the present invention according to FIG. 5A, FIG. 5C illustrates one embodiment of a dither driver that gain converts a voltage 205 representative of dither displacement into a laser gyro count representative of inertial rotation of the gyro 200. There is. All subsequent processing is performed using counts up to the generation of the High Speed Output Content Referenceable Memory (HSO CAM) drive signals 470 and 472. Also in FIG. 5C, the digital signal proceeds to a digital gain amplifier 212 that provides a signal to a pulse width modulation limiter 214, where the limiter 214 provides a pulse width modulation signal 215 to an HSO CAM driver 216 of the digital dither driver. As in the previous embodiment, the PWM signal is determined by the difference between the reference value and the measured displacement value of the block. The high speed output logic in this embodiment of the invention is formed by the HSO unit of the 80C196 KC microprocessor manufactured by INTEL CORPORATION. The fast output logic triggers an event at a given point in time. The event is HSO Command register and HSO It is adjusted by writing commands in what is called the time register. Different events are possible with high speed outputs including A / D changes, timer resets, software flag resets and high speed output line switching. A more detailed knowledge of high speed output logic can be obtained by reference to the INT EL CORPORATION 80C196 KC User's Guide. For details, see Figure 10-1 of the 80C196 KC User's Guide describing the HSO Command Register. Inputs to the dither driver directly come from the HSO CAM driver or the 80C196 KC microcontroller. The structure of the direct dither driver 500 is shown in more detail in connection with FIG. The high speed output CAM driver 216 then provides a dither signal to drive Leg 1 at 470 and Leg 2 at 472. FIG. 5D represents one embodiment of a dither driver such that all processing is performed using the voltage up to the generation of HSO CAM drive signals 470 and 472. Reference is now made to FIG. 6, which shows a detailed interrupt timing diagram of the method of the present invention. The direct drive dither system in one embodiment of the present invention uses the output 430 of the zero-crossing detector of FIG. 2 to trigger an interrupt. Signal 430 of FIG. 2 provides a train of waveforms similar to a timing clock. In FIG. 6, the details of the waveform sequence are shown as a group of square waves 604. The waveform train is shown as the output of signal line 430 as a function of time 602. Signal 604 indicates when gyro block 200 crosses the zero point in its cyclic dither motion, indicated by gyro block position signal 620. The zero crossings are indicated by 618A, 618B, 618C and 618D. The interrupts that have occurred are shown as interrupts 610A, 610B, 610C and 610D. Interrupts occur at the zero crossings 618A, 618B, 618C and 618D of block 200 corresponding to the low-to-high transitions of the output signal 430 at points 605A, 605B, 605C and 605D. By noting when the low-to-high transition occurs, the frequency of dither pickoff 244A can be calculated. In FIG. 6, t 0 Represents the occurrence of transition 605A which generates interrupt 610A, t 1 Represents the occurrence of transition 605 B which generates interrupt 610 B, and t 2 Represents the occurrence of transition 605C which generates interrupt 610C, t 3 Represents the occurrence of transition 605D which generates interrupt 610D. With this set of information for each interrupt, the time difference (t 1 -T 0 ) Is divided into 1 cycle. That is, 1 / (t 1 -T 0 ), The dither frequency can be calculated. This set of information between two or more interrupts allows for the time difference (t) of interrupts 610A and 610D. 3 -T 0 ) Is divided into 3 cycles, that is, 3 / (t 3 -T 0 ), The dither frequency can be calculated. In one embodiment of the direct dither method of the present invention, it is necessary to measure the location of the 90 ° and 270 ° block cycle positions. The 90 ° position is shown in FIG. 6 as points 622 A, 622 B and 622 C. The 270 ° position is shown in FIG. 6 as points 624A, 624B and 624C. Reference is now made to FIG. 7 which illustrates the direct digital dither driver method of the present invention for establishing the 270 ° and 90 ° intersections of the dither cycle. The method first begins with process block 902 which illustrates an interrupt generated by zero crossing detector output 430. The zero-crossing detector is shown as signal 604 in the previous figures FIGS. The interrupt signal from the zero-crossing detector is known as the T2CAP interrupt in one embodiment of the method of the present invention. The process then proceeds to 904 where the T2CAP interrupt service routine is executed. The T2CAP interrupt service routine is described in the process flow chart that follows. At 906, the time when the T2 CAP interrupt is generated is grasped. The process then proceeds to 908 and stores the interrupt time Tn in a temporary register. The process then proceeds to 910 to calculate the change in time from the last interrupt. The first time this process is run, it approximates the initial time. The new time, DeltaT, is established as the difference between the current time and the previous interrupt time. The process then proceeds to 912 and divides the elapsed time between the two interrupts, i.e., the time difference, by 4. This procedure is performed to determine the quadrature involved in the time difference between interrupts. This number is accurate as the resolution of the digital system and represents the amount of time between zero crossings of the dither cycle. This quantity itself represents the actual dither frequency of the laser gyroblock. Then proceed to process 914 to calculate phase lead compensation. Phase lead compensation is established in the T2CAP interrupt shown in FIG. Phase advance is a constant K with delta T PL It is defined as divided by. Delta T corresponds to the amount of time the laser block takes to dither one cycle. That is, Delta T is equal to 360 °. Constant K PL Is a predetermined value based on the dither cycle and the analog delay. For example, a predetermined constant K PL If is equal to 32, the phase advance would be 360 ° / 32, or 11.25 °. T PL The amount of phase lead time, defined as, will be calculated by multiplying the phase lead ratio of the cycle by DeltaT. That is, T PL = Delta T * (11.25 ° / 360 °). The purpose of the phase advance is to provide a dither drive signal that matches the desired actual dither drive signal. This phase advance predicts the related delay in the processing circuit of the dither driver and the related delay in the software processing. The first quadrature Q1 corresponds to the actual displacement of the laser block at the 90 ° position. Phase lead Quadrature Q1 PL Is the actual sample time for the high speed output dither drive CAM 216 shown in FIG. PL Is defined as The process of FIG. 7 then proceeds to 916, where midpoint Q2 is established as being twice the first quadrature sum (Q1 + Q1). The process then proceeds to 918 where the third quadrature Q3 is added to Q2 + Q1. PL To be confirmed. Next, the T2CAP interrupt of FIG. 7 checks for background A / D conversion if necessary. The need for background A / D conversion currently schedules software timer flags and interrupts used by the execution ordering method of the present invention shown in FIG. 12 to solve the use of A / D conversion. Software timer flags and interrupts are scheduled using fast output logic. The process then proceeds to step 919 to order the A / D conversions associated with dither drive and dither stripper along with the background A / D conversions. Process 919 is described in detail in connection with FIG. The process ends at 920 and returns to the return modular gyro monitor control loop shown in FIG. The monitor control loop 390 shown in FIG. 9 is a main process execution loop related to the digital modular gyro 10. The monitor control loop waits for the dither stripper A / D conversion to complete at step 300 before executing the process of the monitor control loop. A conversion complete flag, which when set, indicates that A / D conversion is complete, is included in the device of the present invention. Monitor control loop 390 first illustrates the execution of dither stripper algorithm 302. Compensation of rotational inertial navigation data related to temperature bias drift and age occurs in the next step 304. At 306, the monitor control loop 390 performs the system I / O setup. The process then proceeds to bias drift improvement and random drift improvement steps at 308. The process then proceeds to 310 to process the commands provided by the external system for the modular gyro. The process performs the built-in test function at 312 and checks the laser mode limit at process 314. The monitor control loop 390 then repeats this series of processes until the modular gyro 10 is shut down. Reference is now made to FIG. 15 which illustrates a method of scheduling A / D background conversion. Scheduling of A / D background conversion occurs in a hardware system that has a predetermined set of A / D conversion events that can be queued. The number of A / D changes is predetermined. In one embodiment of the invention, the queue contains seven A / D conversions. The process of ordering those A / D conversions by the monitor control loop shown in FIG. 9 begins first with a step 870 of checking the A / D background conversion done flag. The process then proceeds to 872 and checks the flag to see if the conversion done flag is set. If the flag is not set, the process proceeds out of the routine and returns to the monitor control loop at step 870. In this case, the A / D conversion related to the A / D conversion scheduled in the forefront has not been executed yet, so the A / D conversion cannot be executed. If the conversion done flag is set, the process proceeds to step 874 and stores the current background A / D conversion in the background conversion A / D register. This currently associates background A / D conversion with functions set up by another routine such as temperature measurement, PLC monitoring. The process then proceeds to step 878 to check the background A / D conversion multiplexer pointer. The process then proceeds to 880 to determine what to do after examining the pointer. If the pointer points to the previous background function, then in step 882 the queue is reset to point to the first function. If the pointer is not the previous background function pointer, the process increments at 884 to the next background function pointer. In either case, the process proceeds to step 886 to schedule another background conversion in the queue. The process then exits at 876 into the monitor control loop. Reference is now made to FIG. 8 which illustrates a method of ordering a single analog-to-digital converter among multiple analog signals in a digital dither driving application of the method of the present invention. FIG. 8 illustrates a process flow diagram in which the digital modular gyro 10 transfers the dither stripper conversion time 702 to step 702. The conversion time HsiTime 1 is U.S.C.F. S. Serial No. It is calculated from the dither stripper process described in Applicant's co-pending PCT application based on 07 / 805,122. The process then flows to calculate the expected stripper time calculated from the two values sent in in process 702. The first value is HsiTime 1, which is the start of dither stripper conversion time, and HsiDelta is also sent from the external system via process 702. The expected dither stripper sample time is the sum of HsiTime 1 and HsiDelta. This time is referred to as HsiTime 2. The process then proceeds to 706 where a window is created around HsiTime 2 to lock out the A / D converter involved in dithering. This prevents dither driven A / D conversion and dither stripper A / D conversion from interfering with each other if they occur at the same time. The A / D converter in this embodiment of the invention is an asynchronous converter. A / D conversion occurs asynchronously to the process of setting up the A / D conversion. Process step 708 calculates whether the A / D conversion involved in dither driving occurs within the dither stripper window. The process then branches to either process step 712 or process step 710. Process step 710 sets up a high speed output content referenceable memory (HSO CAM) to schedule phase compensated A / D conversions, software timer flags, and interrupt for a particular dither drive. Process step 712 schedules the software timer flag and sets up the HSO CAM to interrupt the particular dither drive to share the already scheduled dither stripper A / D conversion. The method of the present invention determines which type of action should be taken at a scheduled time, dither stripper transformation, dither driven transformation, dither stripper and dither driven shared transformation, or background transformation. , Check the status of the software time flag. Process step 708 provides a way to schedule a new A / D conversion or share the scheduled conversion with the one that occurs. Implicit in the method of the present invention is that a single A / D conversion in the window is suitable for dither driven applications because the dither stripper A / D conversion always has the highest priority. Is the assumption. In process 712, a flag is set that indicates another routine, a dither drive routine and a dither stripper routine in which A / D conversion is shared. In process step 710, the A / D conversion is scheduled and the result of the conversion is sent to the content referable memory in the microcontroller 100 involved in the fast output logic described below. A / D conversion is scheduled at times Q1 and Q3, which are phase compensated as described above. The process then proceeds to 714 where the A / D converter execution order specification is complete. Reference is now made to FIG. 10 which illustrates a method of calculating a pulse width modulated drive signal from a dither pickoff analog to digital conversion. The method of the present invention embodied in the 80C196 KC Microcontroller 100 begins at process block 821 with an A / D conversion interrupt from the dither drive routine at 822. A reference displacement, which is the amount of angular displacement of the dither motor expressed in read counts that should have occurred, is read from memory at step 824. At step 825, the dither angle reference count is converted to an equivalent analog pickoff signal in digital volts based on the dither stripper gain adjustment. The process then proceeds to 826 where the error in dither motor displacement is calculated as the reference displacement minus the actual displacement. The process then proceeds to 828 where the calculated error is multiplied by a predetermined gain factor, which is 50 in one embodiment of the invention. The process then proceeds to 830, where 830 introduces random noise into the system. In one embodiment of the present invention, which has no limiting meaning, the random noise distribution is a Gaussian distribution. The process then proceeds to 832 where the pulse width modulated signal output is limited to a maximum of 100% PWM and a minimum of 0% PWM to avoid register rollover. In this embodiment of the invention, the limit value is 0 or 255 which represents 0% or 100% PWM. The process then proceeds to step 834 which provides the dither driver with the calculated drive level to bring the dither motor into the reference value adjusted by the introduced random noise. The process then ends at 836. Reference is now made to FIG. 11 which shows a schematic diagram of the A / D conversion handler of the direct digital dither driver. In a modular gyro, A / D conversions are required for dither driven transforms, dither stripper transforms and background transforms as required to calculate the quadrature of the dither. The process shown in FIG. 11 is a method of processing an A / D conversion depending on which process the A / D conversion requested. The method begins at 930 with an A / D conversion interrupt. At process block 932, the source of the A / D conversion comes from the dither driven process at 934, the dither stripper process at 936, the dither stripper and dither driven process 938, or the background process 940. Determine if it occurs from. The stripper and drive step 938 indicates that a dither driven A / D conversion has occurred within the dither stripper A / D conversion window. The dither stripper window is also suitable for dithering, so the process proceeds to step 942 just as for a simple dither stripping operation. Digital drive 934 requesting A / D conversion proceeds directly to dither drive 946. The dither drive routine is described in further detail in FIG. By the time the A / D conversion "occurs", it is already known which process requested the A / D conversion. This was previously determined by the T2CAP interrupt shown in FIG. 8 and the software timer interrupt. If the dither stripper, or the dither drive and dither stripper, requires A / D conversion, the process proceeds to step 942 where the stripper register's A / D value is read. Next, at 944, the A / D conversion complete flag is set to indicate that the stripper or stripper and drive most recent A / D conversion value was in the stripper register and was requested by the stripper and drive. The process then proceeds to dither drive at 946 if either drive or stripper and drive. For background A / D conversion, the process proceeds to 940 where the A / D value is retrieved from the background register at 948 and the conversion done flag for background conversion is set at 950. In either case, the process ends at 952. Reference is now made to FIG. 12 which shows an interrupt service routine for a software timer interrupt for scheduling either a dither only conversion, a shared conversion or a background conversion. The process begins at 1000 by fetching the software timer flag from the special function register at step 1002. Next, the process checks to see if the software timer flag is set for dither driven A / D conversion. If so, the process proceeds to step 1020 to set the dither drive A / D conversion only flag in the A / D priority register in the scratchpad RAM of the microcontroller 100 and ends in step 1022. If dither drive conversion is not indicated, the process proceeds to step 1006, where the process checks to see if the software timer flag is set for drive and stripper conversions. If so, the process proceeds to step 1018 which sets the dither stripper and dither drive shared A / D conversion flag in the A / D priority register in the scratchpad RAM of the microcontroller 100 and ends in step 1022. . If shared conversion is not indicated, the process proceeds to step 1008, where the method of the present invention checks if a dither stripper A / D conversion is in progress. Implicit in the method of FIG. 12 is the condition that if there is no shared or dither driven conversion, it must be a background conversion. The process then proceeds to step 1010 to check if a dither stripper A / D conversion occurs within the window defined as HsiTime + HsiDe lta as described in step 702. If the conversion occurs within the window, the process ends at step 1022. If the conversion does not occur in the window, the process proceeds to step 1014 and waits for the background conversion to complete. Background conversion occurs during a specified period of time, and in one embodiment of the invention, background conversion occurs within 20 microseconds. The process then proceeds to step 1016 and stores the converted value in the background A / D register. The process then ends at step 1022. Those skilled in the art will recognize that the situation of waiting for the completion of the background A / D conversion process can be interrupt driven as described in FIG. 11 or polled as described in FIG. Ah Reference is now made to FIG. 13 which illustrates the method of the present invention used to calculate and predict the occurrence of the next system sample clock. The importance of predicting the sample clock is illustrated by the fact that the external inertial navigation system must obtain inertial navigation data that is synchronized to the uniform external clock throughout the inertial navigation system. Without this capability, inertial navigation data would be supplied asynchronously, resulting in inaccurate inertial position estimates. The process of FIG. 13 begins by starting a counter at process block 150 when the process is first initialized. The process then proceeds to process block 152, which knows the edge of the sample clock from the system, which causes an interrupt at process block 154. The interrupt then initiates a process called interrupt loop 170. The interrupt loop schedules the A / D conversion. At the time the interrupt was generated in process step 154, the count value from the counter in step 150 is stored. The process then proceeds to 158 and reads from memory the last time the interrupt occurred. The process then proceeds to 160 and T-computes the time difference between the old interrupt and the new interrupt as "delta t". The process then proceeds to 162 to set up the A / D conversion on the high speed output of the microprocessor. The new time at which high speed output should occur is the "new t" plus the "delta t". The process then proceeds to 164 where it sets up "old t" equal to "new t" and the process returns to process 152 to find the next sample clock. The method of FIG. 13 dynamically compensates for changes during the system sample clock period and dynamically tracks the movement of the system sample clock. At 162, HSO logic sets up the A / D conversion associated with the dither stripper. The A / D converter 162 is also used by the dither driver described in Applicant's co-pending ring laser gyro direct dither driver. Reference is now made to FIG. 14, which illustrates the method and apparatus of the present invention for driving a laser gyro dither utilizing three analog to digital conversions. It will be appreciated by those skilled in the art that the method of the present invention could be applied to the device described in FIG. In this embodiment, the first A / D converter 1212 provides a properly timed digital representation of the dither pickoff voltage for the dither stripper operation described above. A / D conversion involving the dither stripper must occur when DS1 is active. The microcontroller 100 uses the result of the A / D conversion and the output 1222 of the edge trigger read counter register 1220 to perform the dither stripping operation. The second A / D converter 1214 provides a properly timed digital representation of the dither pickoff voltage for the dither driving operation described above. The A / D conversion involved in dithering must occur when the zero crossing detector 820 is active. The microcontroller 100 uses the A / D conversion result 1204 to perform the dither drive operation. The third A / D converter 1216 provides a digital representation of background processes such as temperature measurements, RIM and LIM measurements, PLC monitoring. Background A / D conversion is enabled by the microcontroller via enable line 1218. Corresponding here to provide the person skilled in the art with the information necessary to comply with the patent law of the present invention and to apply the new principles and to configure and use such specialized devices as required. Explained in detail. It should be understood, however, that the invention may be specified and practiced by different devices and apparatus, and that various changes can be made in both the details and the operating procedure of the device without departing from the scope of the invention itself.
─────────────────────────────────────────────────────
フロントページの続き
(72)発明者 ブレント,デイル・エフ
アメリカ合衆国 55441 ミネソタ州・プ
リマス・パインビュー レイン ノース・
335─────────────────────────────────────────────────── ───
Continued front page
(72) Inventor Brent, Dale F
United States 55441 Minnesota
Limas Pine View Rain North
335