JP3776795B2 - Inertial device - Google Patents

Inertial device Download PDF

Info

Publication number
JP3776795B2
JP3776795B2 JP2001389770A JP2001389770A JP3776795B2 JP 3776795 B2 JP3776795 B2 JP 3776795B2 JP 2001389770 A JP2001389770 A JP 2001389770A JP 2001389770 A JP2001389770 A JP 2001389770A JP 3776795 B2 JP3776795 B2 JP 3776795B2
Authority
JP
Japan
Prior art keywords
external clock
clock signal
data
inertial
signal
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Lifetime
Application number
JP2001389770A
Other languages
Japanese (ja)
Other versions
JP2003185465A (en
Inventor
竜太郎 竹内
勝彦 上西
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Japan Aviation Electronics Industry Ltd
Original Assignee
Japan Aviation Electronics Industry Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Japan Aviation Electronics Industry Ltd filed Critical Japan Aviation Electronics Industry Ltd
Priority to JP2001389770A priority Critical patent/JP3776795B2/en
Publication of JP2003185465A publication Critical patent/JP2003185465A/en
Application granted granted Critical
Publication of JP3776795B2 publication Critical patent/JP3776795B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Images

Landscapes

  • Navigation (AREA)

Description

【0001】
【発明の属する技術分野】
本発明は、航空機、ロケットその他の移動体に搭載され、ジャイロ及び加速度計でなる慣性センサにより移動体の角速度および加速度を検知し、該角速度および加速度に基づき該移動体の姿勢角、速度、位置などの慣性データを演算する慣性装置に関し、特にオートパイロット等の外部機器から供給される外部クロック信号を受け、外部クロック信号に同期して慣性データを該外部機器へ出力できる慣性装置に関する。
【0002】
【従来の技術】
一般に慣性装置は、航空機、ロケットその他の移動体に搭載され、慣性センサおよび演算処理部を備え、移動体の姿勢角、速度および位置を生成する。移動体の姿勢角、速度および位置は、移動体の慣性データと称される。慣性センサは、X,Y及びZの直交3軸に関する移動体の角速度を検知するジャイロと、その直交3軸に関する移動体の加速度を検知する加速度計とでなる。慣性センサで検知された角速度および加速度は、ここではセンサ出力と称することとする。演算処理部は、そのセンサ出力に基づき移動体の姿勢角、速度および位置、すなわち慣性データを演算する。センサ出力(角速度および加速度)に基づき移動体の慣性データ(姿勢角、速度および位置)を求める演算は、慣性演算と称される。慣性演算は、センサ出力に積分演算を施し、X,Y及びZの直交3軸に関する移動体の角度および速度を求めるとともに、該角度および速度のデータを処理し、移動体の姿勢、速度および位置を求める演算である。慣性データは、例えば移動体のオートパイロット装置(自動操縦装置)に提供され、移動体の操縦系制御データとして利用される。図4および図5は、従来から知られている慣性装置の構成をそれぞれ示す図である。前記オートパイロット装置は外部機器の一例である。
【0003】
図4の慣性装置41(第1の従来例)は、慣性センサ2と、アップダウン・カウンタ3と、演算処理部44と、外部接続回路6とを備えてなり、外部機器16に対し慣性データをデータバス14経由で供給する。慣性センサ2は、角加速度を検出するジャイロ及び加速度を検出する加速度計でなり、X,Y及びZの直交3軸に関する角速度および加速度をセンサ出力101として出力する。そして、慣性センサ2は、センサ出力101におけるデータ(X,Y及びZの直交3軸に関する角速度または加速度)それぞれに対応してアップ端子およびダウン端子を有し、そのデータが正の値のときは、そのデータの大きさを表す数のパルスをアップ端子から出力し、データが負の値のときは、そのデータの大きさを表す数のパルスをダウン端子から出力する。
【0004】
アップダウン・カウンタ3は、慣性センサ2のアップ端子およびダウン端子にそれぞれ対応してアップカウント入力端子およびダウンカウント入力端子を備える。慣性センサ2のアップ端子はアップカウント入力端子に接続され、慣性センサ2のダウン端子はダウンカウント入力端子に接続されている。アップダウン・カウンタ3は、演算処理部44から供給されるクロック信号402のタイミングで、アップカウント入力端子へ入力されたパルス数だけ計数値を加算(カウントアップ)し、ダウンカウント入力端子へ入力されたパルス数だけ計数値を減算(カウントダウン)する。アップダウン・カウンタ3におけるこの計数処理をアップダウン・カウント処理と称する。アップダウン・カウント処理は、センサ出力101をクロック信号402の周期で計数するので、一種の積分処理である。クロック信号402の周期は、例えば1m秒といった程度の時間である。アップダウン・カウンタ3のアップダウン・カウント処理出力103は、演算処理部44に送られる。演算処理部44は、アップダウン・カウント処理出力103につき慣性演算を行い、慣性データ144を生成する。演算処理部44における慣性演算には、アップダウン・カウント処理出力103の積分演算が含まれる。慣性データ144は、外部接続回路6とデータバス14とを介して外部機器16へ供給される。
【0005】
この図4の従来例においては、アップダウン・カウンタ3におけるアップダウン・カウント処理と演算処理部44における慣性演算処理とが、外部機器16のクロック信号とは関わりのない独自のタイミングで、すなわち外部機器16内における処理動作とは非同期で行われる。そこで、慣性装置41と外部機器16との機器間における処理タイミングにずれが生じることは避けがたく、外部機器16が慣性データ144を受けた時、該慣性データ144がどの時点で取得した移動体の物理的な運動状態であるかを外部機器16では正確には知り得ない。したがって、図4の慣性装置では、慣性データ144と移動体の物理的な運動状態との間の誤差が避けられない。
【0006】
図5の慣性装置51(第2の従来例)は、この欠点を解消することを意図した従来例であり、各構成要素は図4の装置におけるものと同じである。図5の慣性装置51が図4の慣性装置41と異なるところは、外部機器16から出力される外部クロック信号102が、慣性装置51内に導入されている点である。外部クロック信号102の周波数は、例えば1kHzである。
【0007】
図5において、慣性センサ2のセンサ出力101は、アップダウン・カウンタ3に入力され、外部クロック信号102に基づくタイミングでアップダウン・カウント処理を施される。アップダウン・カウンタ3のアップダウン・カウント処理出力103は、演算処理部44に送られる。演算処理部44は、外部クロック信号102のタイミングで、アップダウン・カウント処理出力103につき慣性演算処理を施し、慣性データ144を生成する。この慣性演算は、図4における演算と同様に積分演算を含む。この図5の慣性装置51では、積分演算の積分期間の開始と終了は、外部クロック信号102のタイミングである。この慣性データ144は、図4の従来例の場合と同様に、外部接続回路6とデータバス14とを介して外部機器16へ供給される。
【0008】
なお、図4の慣性装置41におけるアップダウン・カウンタ3について述べたように、アップダウン・カウンタ3における計数処理は一種の積分処理であり、演算処理部44でも積分処理が行われるが、アップダウン・カウンタ3における計数処理は1m秒程度の短時間の計数であり、演算処理部44における積分処理はより長い時間に関しアップダウン・カウント処理出力103を積分することにより行われる。演算処理部44は、外部クロック信号102を受け、外部クロック信号102の周波数を分周した内部クロック信号を生成し、内部クロック信号のタイミングで積分処理をしている。
【0009】
図5の従来例においては、アップダウン・カウンタ3および演算処理部44の処理動作を、外部機器16の外部クロック信号102に同期させるので、慣性データ144は上位の外部機器16において待ち受けるタイミングで外部機器16に対し供給される。したがって、図5の慣性装置51(第2の従来例)では、図4の慣性装置41(第1の従来例)における欠点は一応回避される。
【0010】
【発明が解決しようとする課題】
上述した従来例において、第1の従来例の欠点を補うために提案されている第2の従来例の場合には、慣性装置51内のアップダウン・カウンタ3及び演算処理部44の処理動作は、外部機器16の外部クロック信号102に同期して行われており、慣性装置51の出力の慣性データ144と外部機器16のデータ受信タイミングとの間の時間ズレの発生は一応回避され、慣性データ144がどの時点で取得した移動体の物理的な運動状態を表すかを外部機器16で正確に知り得る。しかしながら、演算処理部44における慣性演算処理は積分演算を含み、該積分演算の開始から終了までの時間区間は外部クロック信号102で規定されるので、外部クロック信号102の周期に変動があると、積分演算の積分時間区間の誤差となり、該積分時間区間の誤差が、演算処理部44における慣性演算による慣性データ144(姿勢角、速度および位置)の精度劣化にそのままつながるという欠点がある。
【0011】
そこで、本発明の目的は、上記の欠点を排除し、外部クロック信号に同期した慣性データを、外部クロック信号の周期に変動があっても、高い精度で外部機器に供給できる慣性装置を提供することにある。
【0012】
【課題を解決するための手段】
前述の課題を解決するために本発明は次の手段を提供する。
【0013】
(1)移動体の角速度および加速度を検出する慣性センサと、該慣性センサの出力を受ける演算手段とを備え、外部機器から出力される外部クロック信号を該演算手段に受け、該外部クロック信号の繰り返し周期に基づく時間に関し該慣性センサ出力に積分演算処理を施すことにより、該移動体の慣性データを求め、該慣性データを該外部機器へ伝達する慣性装置において、
前記外部クロック信号の繰り返し周期を測定し、該繰り返し周期を表す外部クロック周期データを生成する外部クロック周期測定回路を備え、
前記演算手段は、前記外部クロック周期データを受け、該外部クロック周期データで表される前記繰り返し周期と基準値との差を外部クロック周期誤差として求め、該外部クロック周期誤差に基づき該外部クロックの周期を補正することにより、繰り返し周期の補正された補正外部クロックを生成し、該補正外部クロックの繰り返し周期に基づく時間に関し該慣性センサ出力に積分演算処理を施すことにより、該移動体の慣性データを求め、該慣性データを該外部機器へ伝達する
ことを特徴とする慣性装置。
【0014】
(2)前記慣性センサは、前記角速度を検出するジャイロと前記加速度を検出する加速度計とを含み、
前記演算手段は、前記外部クロック信号のタイミングで前記慣性センサ出力にアップダウン・カウント処理を施し、アップダウン・カウント処理出力を生成するアップダウン・カウンタと、該アップダウン・カウント処理出力に積分演算処理を施すことにより前記慣性データを生成する演算処理部でなり、
前記演算処理部は、前記外部クロック周期測定回路の作動を制御する制御信号および基準クロック信号を前記外部クロック周期測定回路へ供給し、
前記基準クロック信号の繰り返し周波数は、前記外部クロック信号の繰り返し周波数より大きく、
前記外部クロック周期測定回路は、前記外部クロック信号の繰り返し周期のパルス幅のパルス信号を生成する外部クロック信号繰り返し周期検出手段と、該パルス幅の時間を前記基準クロック信号で計数する計数手段と、該計数手段から出力される計数値を取り出し、該計数値を前記外部クロック周期データとして前記前記演算処理部へ送出する手段とを有し、
前記外部クロック信号繰り返し周期検出手段は、前記外部クロック信号における連続する第1及び第2の繰り返し周期をそれぞれ表す第1及び第2のパルス信号を生成し、
前記計数手段は、前記第1及び第2のパルス信号における前記パルス幅を前記基準クロック信号でそれぞれ計数する第1及び第2のカウンタでなり、
前記送出手段は、前記第1及び第2のカウンタの計数値をそれぞれ取り出す第1及び第2のバッファと、該第1及び第2のバッファに取り出された該第1及び第2カウンタの計数値を前記外部クロック周期データとして前記演算処理部へ導くデータバスとでなり、
前記制御信号は、前記計数手段における計数期間並びに前記第1及び第2のバッファによる前記第1及び第2カウンタの計数値の取り出しタイミングを制御する
ことを特徴とする前記(1)に記載の慣性装置。
【0015】
(3)前記外部クロック信号繰り返し周期検出手段は、前記外部クロック信号をラッチして、該外部クロック信号に同期し、且つ外部クロック信号の各周期ごとに交互にハイレベル及びロウレベルに切り替わるパルス信号を前記第1のパルス信号として生成するラッチと、該第1のパルス信号の極性を反転して、前記第2のパルス信号を生成するインバータとでなる
ことを特徴とする前記(2)に記載の慣性装置。
【0016】
(4)前記補正外部クロックは、前記外部クロックを分周した内部クロックの繰り返し周期を前記外部クロック周期誤差に基づき補正したクロックであることを特徴とする前記(1)乃至(3)に記載の慣性装置。
【0017】
【発明の実施の形態】
次に、本発明の実施の形態を挙げ、本発明の慣性装置を一層具体的に説明する。
【0018】
図1は、本発明の一実施の形態の構成を示すブロック図である。図1に示されるように、本実施例の慣性装置1は、慣性センサ2と、アップダウン・カウンタ3と、演算処理部4と、外部クロック周期測定回路5と、外部接続回路6とを備えて構成される。また、図2は、外部クロック周期測定回路5の一実施例の内部構成を示す図であり、図3(a),(b),(c),(d),(e),(f),(g),(h),(i),(j)及び(k)は、外部クロック周期測定回路5における各部信号のタイミング図である。図2に示されるように、外部クロック周期測定回路5は、演算処理部4に対応して、ラッチ7と、インバータ8と、カウンタ9,10と、バッファ11,12とを備えて構成される。
【0019】
図1において、慣性センサ2において検出されたセンサ出力101(前述の慣性センサ出力に相当)は、アップダウン・カウンタ3に入力され、外部機器16から供給される外部クロック信号102のタイミングでアップダウン・カウント処理される。慣性センサ2及びアップダウン・カウンタ3の作動は図5について述べたところと同様である。アップダウン・カウンタ3から出力されるアップダウン・カウント処理出力103は、演算処理部4に入力される。演算処理部4ではアップダウン・カウント処理出力103につき慣性演算処理が行われることは、図4及び図5の従来の慣性装置と同様である。本実施の形態の慣性装置1は、外部クロック周期測定回路5が外部クロック信号102の繰り返し周期を測定し、その外部クロック信号102の繰り返し周期を外部クロック周期データとしてデータバス13経由で演算処理部4へ供給する点を特徴とする。
【0020】
演算処理部4は、外部クロック周期データで示される積分時間区間が所定の外部クロック周期(前述の基準値に相当)からずれている量を誤差(前述の外部クロック周期誤差に相当)とし、外部クロック信号102を分周した内部クロックの周期を該誤差に基づき補正し、外部クロック信号102の周波数変動の影響を除いた正確な慣性データを得ることができる。
【0021】
外部クロック周期測定回路5に対しては、外部クロック信号102が入力されており、また演算処理部4からは基準クロック信号104、カウンタ(9)クリア信号107、カウンタ(10)クリア信号108、バッファ(11)イネーブル信号111及びバッファ(12)イネーブル信号112が入力されている。信号107,108,111及び112は前述の制御信号に相当する。外部クロック周期測定回路5からは、外部クロック信号102の繰り返し周期を表す外部クロック周期データ〔カウンタ(9)計数データ109およびカウンタ(10)計数データ110を交互に選択して構成したデータ〕がデータバス13を介して演算処理部4へ出力される。
【0022】
演算処理部4においては、上述のように、該外部クロック周期データにより外部クロック信号102の繰り返し周期を知り、外部クロック信号102の基準繰り返し周期に対し実際の外部クロック信号102の繰り返し周期がずれている時間量を外部クロック信号(102)繰り返し周期誤差として求める。そして、演算処理部4は、外部クロック信号102を分周した内部クロックの繰り返し周期を外部クロック信号(102)繰り返し周期誤差に基づき補正することにより、補正外部クロックを生成し、補正外部クロックの繰り返し周期に基づく時間でアップダウン・カウント処理出力103の時間積分をし、慣性データを生成する。アップダウン・カウント処理出力103の時間積分で得られる慣性データは、その外部クロック信号102の繰り返し周期が基準値であるときにその基準値の繰り返し周期で積分して得らえる慣性データとほぼ同じ精度である。この慣性データは、データバス14を介して外部接続回路6に入力され、更にデータバス15を経由して外部機器16へ伝送される。
【0023】
このように、演算処理部4における慣性演算においては、外部クロック信号102の繰り返し周期の誤差を求め、慣性データの演算精度の向上を図ることができる。以下においては、図1、図2および図3を参照し、本実施の形態について、外部クロック周期測定回路5の一実施例の動作内容に主眼をおいて説明する。
【0024】
図1に示されるように、外部機器16より出力される外部クロック信号102(図3(b)参照)は、前述のように、アップダウン・カウンタ3に入力されるとともに、演算処理部4および外部クロック周期測定回路5に対しても入力される。外部クロック周期測定回路5に対しては、基準クロック信号104(図3(a)参照)が演算処理部4から供給され、さらに制御信号として、カウンタ(9)クリア信号107(図3(g)参照)、カウンタ(10)クリア信号108(図3(h)参照)、バッファ(11)イネーブル信号111(図3(i)参照)およびバッファ(12)イネーブル信号112(図3(j)参照)が演算処理部4から供給されている。外部クロック信号102の周波数は1kHzである。基準クロック信号104は、演算処理部4内の発信器により生成され、10MHzの安定した周波数の信号であり、外部クロック信号102とは非同期である。
【0025】
図2において、外部機器16からの外部クロック信号102は、ラッチ7に入力され、ラッチ7からは、カウンタ・イネーブル信号105(前述の第1のパルス信号に相当。図3(c)参照)が出力されて、カウンタ9に入力されるとともに、インバータ8により反転されて、反転カウンタ・イネーブル信号106(前述の第2のパルス信号に相当。図3(d)参照)として、カウンタ10に入力される。
【0026】
カウンタ9(前述の第1のカウンタに相当)は、カウンタ・イネーブル信号105と、基準クロック信号104を受けて、図3(e)に示されるように、タイミングT1 からT2 に至る間において、基準クロック信号104の計数を行う。カウンタ9における計数値は、カウンタ(9)計数データ109として、該タイミングT2 以降の時間帯において保持される。カウンタ(9)計数データ109は、外部クロック信号102の周期を表す。同様に、カウンタ10(前述の第2のカウンタに相当)には、反転カウンタ・イネーブル信号106と、基準クロック信号104とを受けて、図3(f)に示されるように、タイミングT2 からT5 に至る間において、基準クロック信号104の計数を行う。カウンタ10における計数値は、カウンタ(10)計数データ110として、該タイミングT5 以降の時間帯において保持される。カウンタ(10)計数データ110は、カウンタ(9)計数データ109と同様に、外部クロック信号102の周期を表す。カウンタ(9)計数データ109及びカウンタ(10)計数データ110は、外部クロック信号102における交互の繰り返し周期をそれぞれ表す。
【0027】
バッファ11(前述の第1のバッファに相当)は、図3(i)に示されるように、タイミングT3 において、演算処理部4から出力されるバッファ(11)イネーブル信号111を受けて、タイミングT2 以降、カウンタ9にデータ保持されていたカウンタ(9)計数データ109の取り込みを行う。カウンタ(9)計数データ109は、バッファ11及びデータバス13を介して演算処理部4に伝送される。カウンタ(9)計数データ109の転送後のタイミングT4 においては、演算処理部4から、カウンタ9に対してカウンタ(9)クリア信号107が入力され、カウンタ9に保持されていたカウンタ(9)計数データ109はクリアされる。
【0028】
カウンタ9及びバッファ11に関するこれらの一連の連係動作は、カウンタ10及びバッファ12(前述の第2のバッファに相当)についても全く同様である。バッファ12においては、図3(j)に示されるように、タイミングT6 において、演算処理部4から出力されるバッファ(12)イネーブル信号112を受けて、タイミングT5 以降、カウンタ10にデータ保持されていたカウンタ(10)計数データ110の取り込みが行われ、カウンタ(10)計数データ110は、バッファ12及びデータバス13を介して演算処理部4へ伝送される。カウンタ(10)計数データ110の転送後のタイミングT7 において、演算処理部4から、カウンタ10に対してカウンタ(10)クリア信号108が入力され、カウンタ10に保持されていたカウンタ(10)計数データ110はクリアされる。
【0029】
図3(k)は、カウンタ(9)計数データ109およびカウンタ(10)計数データ110が、それぞれデータバス13を経由して外部機器16に伝送される際の、該データバス13の利用時間帯を概念的に示した図である。バッファ(11)イネーブル信号111及びバッファ(12)イネーブル信号112に対応する伝送時間帯13aにおいて、カウンタ計数データ109,110は、データバス13を経由して演算処理部4に逐次に伝送される即ち、カウンタ(9)計数データ109及びカウンタ(10)計数データ110は、外部クロック信号102に同期して、データバス13を経由して、演算処理部4へ交互に出力される。カウンタ計数データ109及び110は、前述のとおり、データバス13を経由して演算処理部4へ交互に供給されるとき、演算処理部4は外部クロック周期データなる一体のデータとしてデータ109及び110を認識する。また図3(k)において符合13bとして示される期間は、データバス13がハイインピーダンス状態にある時間帯を示しており、カウンタ計数データ109,110以外の他のデータ信号の伝送に利用できる伝送時間帯を示している。
【0030】
かくして、図2の外部クロック周期測定回路5は、カウンタ計数データ109及び110で構成される外部クロック周期データを演算処理部4へ供給し、演算処理部4は外部クロック周期データに基づき外部クロック信号102の繰り返し周期の誤差(外部クロック周期誤差)を演算し、その外部クロック周期誤差に基づき外部クロック信号102の繰り返し周期を補正し、補正外部クロックを生成し、該補正外部クロックの繰り返し周期に基づく時間でアップダウン・カウント処理出力103の時間積分をする。時間積分における時間データが正確であるから、演算処理部4は、外部クロック信号102の繰り返し周期の誤差の影響を除いた正確な慣性データを演算することができる。但し、基準クロック信号104は外部クロック信号102とは非同期であるから、外部クロック周期測定回路5で測定される外部クロック信号102の繰り返し周期には、最大で基準クロック信号104の2周期分の誤差はある。しかし、この実施例では、基準クロック信号104は10MHzであるから、この2周期分の誤差は200ナノ秒(ns)であり、外部クロック信号102の繰り返し周期に生じ得る数十マイクロ秒の変動に比べ、無視し得る大きさである。
【0031】
また、外部クロック信号102の繰り返し周期の誤差が、外部クロック信号102の繰り返し周期のジッタによるものであり、そのジッタが比較的大きい値であっても、本実施の形態では、外部クロック信号102の繰り返し周期を1周期ごとに測定しているので、外部クロック信号102の繰り返し周期に応じて演算して得た慣性データにそのジッタに基づく誤差があっても、その誤差を補正した正確な慣性データを出力できる。外部クロック周期測定回路が、外部クロック信号102における複数の繰り返し周期の平均値を測定するのであれば、個別のジッタに基づく積分値の誤差は補正できないが、本実施の形態では、上述のとおり、外部クロック信号102の繰り返し周期を1周期ごとに測定しているので、繰り返し周期ごとのジッタに基づく誤差をも補正できるのである。
【0032】
【発明の効果】
以上に説明したように、本発明によれば、外部クロック信号の周期に変動があっても、外部クロック信号に同期した慣性データを高い精度で外部機器に供給できる慣性装置を提供できる。
【図面の簡単な説明】
【図1】本発明の一実施の形態を示すブロック図である。
【図2】図1の実施の形態における外部クロック周期測定回路の一実施例を示す構成図である。
【図3】図2の外部クロック周期測定回路における各部の信号を示すタイミング図である。
【図4】従来例を示すブロック図である。
【図5】他の従来例を示すブロック図である。
【符号の説明】
1,41,51 慣性装置
2 慣性センサ
3 アップダウン・カウンタ
4,44 演算処理部
5 外部クロック周期測定回路
6 外部接続回路
7 ラッチ
8 インバータ
9,10 カウンタ
11,12 バッファ
13,14,15 データバス
16 外部機器
101 センサ出力
102 外部クロック信号
103 アップダウン・カウンタ3のアップダウン・カウント処理出力
104 基準クロック信号
105 カウンタ・イネーブル信号
106 反転カウンタ・イネーブル信号
107 カウンタ(9)クリア信号
108 カウンタ(10)クリア信号
109 カウンタ(9)計数データ
110 カウンタ(10)計数データ
111 バッファ(11)イネーブル信号
112 バッファ(12)イネーブル信号
144 慣性データ
402 クロック信号
[0001]
BACKGROUND OF THE INVENTION
The present invention is mounted on an aircraft, rocket, or other moving body, and detects the angular velocity and acceleration of the moving body by an inertial sensor composed of a gyro and an accelerometer, and the posture angle, speed, and position of the moving body based on the angular velocity and acceleration. In particular, the present invention relates to an inertial device capable of receiving an external clock signal supplied from an external device such as an autopilot and outputting the inertial data to the external device in synchronization with the external clock signal.
[0002]
[Prior art]
In general, an inertial device is mounted on an aircraft, a rocket, or other moving body, and includes an inertial sensor and an arithmetic processing unit, and generates an attitude angle, a speed, and a position of the moving body. The posture angle, speed, and position of the moving body are referred to as inertial data of the moving body. The inertial sensor includes a gyro that detects the angular velocity of the moving body with respect to the three orthogonal axes of X, Y, and Z, and an accelerometer that detects the acceleration of the moving object with respect to the three orthogonal axes. Here, the angular velocity and acceleration detected by the inertial sensor are referred to as sensor output. The arithmetic processing unit calculates the attitude angle, speed, and position of the moving body, that is, inertia data based on the sensor output. The calculation for obtaining inertial data (attitude angle, speed and position) of the moving body based on the sensor output (angular velocity and acceleration) is called inertia calculation. Inertial calculation performs integral calculation on the sensor output to determine the angle and speed of the moving body with respect to three orthogonal axes of X, Y, and Z, and processes the data of the angle and speed to determine the attitude, speed, and position of the moving body. Is an operation for obtaining. Inertia data is provided to, for example, an autopilot device (automatic piloting device) of a mobile object and used as control system control data of the mobile object. FIG. 4 and FIG. 5 are diagrams respectively showing configurations of conventionally known inertia devices. The autopilot device is an example of an external device.
[0003]
4 includes an inertial sensor 2, an up / down counter 3, an arithmetic processing unit 44, and an external connection circuit 6. The inertial device 41 in FIG. Is supplied via the data bus 14. The inertial sensor 2 includes a gyro that detects angular acceleration and an accelerometer that detects acceleration. The inertial sensor 2 outputs angular velocity and acceleration about three orthogonal axes of X, Y, and Z as a sensor output 101. The inertial sensor 2 has an up terminal and a down terminal corresponding to each data (angular velocity or acceleration regarding three orthogonal axes of X, Y, and Z) in the sensor output 101, and when the data is a positive value The number of pulses representing the magnitude of the data is outputted from the up terminal, and when the data is a negative value, the number of pulses representing the magnitude of the data is outputted from the down terminal.
[0004]
The up / down counter 3 includes an up count input terminal and a down count input terminal corresponding to the up terminal and the down terminal of the inertial sensor 2, respectively. The up terminal of the inertial sensor 2 is connected to the upcount input terminal, and the down terminal of the inertial sensor 2 is connected to the downcount input terminal. The up / down counter 3 adds (counts up) the count value by the number of pulses input to the up-count input terminal at the timing of the clock signal 402 supplied from the arithmetic processing unit 44, and is input to the down-count input terminal. The count value is subtracted (counted down) by the number of pulses counted. This counting process in the up / down counter 3 is referred to as an up / down counting process. The up / down counting process is a kind of integration process because the sensor output 101 is counted in the cycle of the clock signal 402. The period of the clock signal 402 is a time of about 1 ms, for example. The up / down count processing output 103 of the up / down counter 3 is sent to the arithmetic processing unit 44. The arithmetic processing unit 44 performs inertia calculation for the up / down / count processing output 103 to generate inertia data 144. The inertia calculation in the calculation processing unit 44 includes integration calculation of the up / down / count processing output 103. The inertia data 144 is supplied to the external device 16 via the external connection circuit 6 and the data bus 14.
[0005]
In the conventional example of FIG. 4, the up / down counting process in the up / down counter 3 and the inertia calculation process in the arithmetic processing unit 44 are performed at an independent timing that is not related to the clock signal of the external device 16, that is, externally. The processing operation in the device 16 is performed asynchronously. Accordingly, it is unavoidable that the processing timing between the inertial device 41 and the external device 16 is shifted, and when the external device 16 receives the inertial data 144, the mobile object acquired by the inertial data 144 at any point in time. It is impossible for the external device 16 to know exactly whether the physical motion state is. Therefore, in the inertial device of FIG. 4, an error between the inertial data 144 and the physical motion state of the moving body is unavoidable.
[0006]
An inertial device 51 (second conventional example) in FIG. 5 is a conventional example intended to eliminate this drawback, and each component is the same as that in the device in FIG. The inertial device 51 in FIG. 5 differs from the inertial device 41 in FIG. 4 in that an external clock signal 102 output from the external device 16 is introduced into the inertial device 51. The frequency of the external clock signal 102 is 1 kHz, for example.
[0007]
In FIG. 5, the sensor output 101 of the inertial sensor 2 is input to the up / down counter 3 and subjected to an up / down count process at a timing based on the external clock signal 102. The up / down count processing output 103 of the up / down counter 3 is sent to the arithmetic processing unit 44. The arithmetic processing unit 44 performs inertia calculation processing on the up / down count processing output 103 at the timing of the external clock signal 102 to generate inertia data 144. This inertia calculation includes an integral calculation similar to the calculation in FIG. In the inertial device 51 of FIG. 5, the start and end of the integration period of the integration calculation is the timing of the external clock signal 102. The inertial data 144 is supplied to the external device 16 via the external connection circuit 6 and the data bus 14 as in the case of the conventional example of FIG.
[0008]
As described for the up / down counter 3 in the inertial device 41 of FIG. 4, the counting process in the up / down counter 3 is a kind of integration process, and the calculation processing unit 44 also performs the integration process. The counting process in the counter 3 is a short time count of about 1 msec, and the integration process in the arithmetic processing unit 44 is performed by integrating the up / down count process output 103 for a longer time. The arithmetic processing unit 44 receives the external clock signal 102, generates an internal clock signal obtained by dividing the frequency of the external clock signal 102, and performs integration processing at the timing of the internal clock signal.
[0009]
In the conventional example of FIG. 5, the processing operations of the up / down counter 3 and the arithmetic processing unit 44 are synchronized with the external clock signal 102 of the external device 16, so that the inertial data 144 is Supplied to the device 16. Therefore, in the inertial device 51 (second conventional example) of FIG. 5, the disadvantages of the inertial device 41 (first conventional example) of FIG. 4 are avoided.
[0010]
[Problems to be solved by the invention]
In the above-described conventional example, in the case of the second conventional example proposed to compensate for the disadvantages of the first conventional example, the processing operations of the up / down counter 3 and the arithmetic processing unit 44 in the inertial device 51 are as follows. The time difference between the inertial data 144 output from the inertial device 51 and the data reception timing of the external device 16 is temporarily avoided, and the inertial data is generated. The external device 16 can accurately know at what point 144 represents the physical motion state of the mobile object acquired. However, the inertia calculation process in the calculation processing unit 44 includes an integral calculation, and the time interval from the start to the end of the integral calculation is defined by the external clock signal 102. Therefore, if the cycle of the external clock signal 102 varies, There is a defect that an error occurs in the integration time interval of the integration calculation, and the error in the integration time interval directly leads to deterioration in accuracy of the inertial data 144 (attitude angle, speed, and position) due to the inertia calculation in the calculation processing unit 44.
[0011]
SUMMARY OF THE INVENTION Accordingly, an object of the present invention is to provide an inertial apparatus that eliminates the above-mentioned drawbacks and can supply inertial data synchronized with an external clock signal to an external device with high accuracy even if the period of the external clock signal varies. There is.
[0012]
[Means for Solving the Problems]
In order to solve the above-mentioned problems, the present invention provides the following means.
[0013]
(1) An inertial sensor that detects the angular velocity and acceleration of a moving body, and a calculation unit that receives the output of the inertial sensor. The calculation unit receives an external clock signal output from an external device. In an inertial apparatus that obtains inertial data of the moving body by performing integral calculation processing on the output of the inertial sensor with respect to time based on a repetition period, and transmits the inertial data to the external device.
An external clock period measuring circuit for measuring a repetition period of the external clock signal and generating external clock period data representing the repetition period;
The arithmetic means receives the external clock cycle data, obtains a difference between the repetition cycle represented by the external clock cycle data and a reference value as an external clock cycle error, and based on the external clock cycle error, By correcting the cycle, a corrected external clock having a corrected repetition cycle is generated, and the inertial sensor output is subjected to an integral calculation process with respect to the time based on the repetition cycle of the corrected external clock, whereby the inertial data of the moving body is obtained. And inertia data is transmitted to the external device.
[0014]
(2) The inertial sensor includes a gyro that detects the angular velocity and an accelerometer that detects the acceleration,
The arithmetic means performs an up / down count process on the inertial sensor output at the timing of the external clock signal, and generates an up / down count process output; and an integral operation on the up / down count process output An arithmetic processing unit that generates the inertial data by performing processing,
The arithmetic processing unit supplies a control signal and a reference clock signal for controlling the operation of the external clock cycle measuring circuit to the external clock cycle measuring circuit,
The repetition frequency of the reference clock signal is greater than the repetition frequency of the external clock signal,
The external clock period measuring circuit includes an external clock signal repetition period detecting means for generating a pulse signal having a pulse width of a repetition period of the external clock signal, a counting means for counting the time of the pulse width with the reference clock signal, Taking out the count value output from the counting means, and sending the count value as the external clock cycle data to the arithmetic processing unit,
The external clock signal repetition period detecting means generates first and second pulse signals respectively representing first and second repetition periods that are continuous in the external clock signal;
The counting means includes first and second counters for counting the pulse widths in the first and second pulse signals with the reference clock signal, respectively.
The sending means includes first and second buffers that respectively extract count values of the first and second counters, and count values of the first and second counters that are extracted to the first and second buffers. A data bus that leads to the arithmetic processing unit as the external clock cycle data,
The inertia according to (1), wherein the control signal controls a counting period in the counting means and a timing of taking out the count values of the first and second counters by the first and second buffers. apparatus.
[0015]
(3) The external clock signal repetition period detecting means latches the external clock signal and generates a pulse signal that is synchronized with the external clock signal and alternately switches between a high level and a low level for each period of the external clock signal. The latch described as the first pulse signal and an inverter that generates the second pulse signal by inverting the polarity of the first pulse signal according to (2), Inertial device.
[0016]
(4) The correction external clock is a clock obtained by correcting a repetition period of an internal clock obtained by dividing the external clock based on the external clock period error, according to (1) to (3), Inertial device.
[0017]
DETAILED DESCRIPTION OF THE INVENTION
Next, the inertial device of the present invention will be described more specifically with reference to an embodiment of the present invention.
[0018]
FIG. 1 is a block diagram showing the configuration of an embodiment of the present invention. As shown in FIG. 1, the inertial device 1 of the present embodiment includes an inertial sensor 2, an up / down counter 3, an arithmetic processing unit 4, an external clock period measuring circuit 5, and an external connection circuit 6. Configured. FIG. 2 is a diagram showing an internal configuration of an embodiment of the external clock cycle measuring circuit 5, and FIGS. 3 (a), (b), (c), (d), (e), (f) , (G), (h), (i), (j), and (k) are timing charts of respective signals in the external clock period measuring circuit 5. As shown in FIG. 2, the external clock cycle measuring circuit 5 includes a latch 7, an inverter 8, counters 9 and 10, and buffers 11 and 12 corresponding to the arithmetic processing unit 4. .
[0019]
In FIG. 1, a sensor output 101 (corresponding to the aforementioned inertial sensor output) detected by the inertial sensor 2 is input to the up / down counter 3 and up / down at the timing of the external clock signal 102 supplied from the external device 16.・ Count processing is performed. The operation of the inertial sensor 2 and the up / down counter 3 is the same as described with reference to FIG. The up / down count processing output 103 output from the up / down counter 3 is input to the arithmetic processing unit 4. In the arithmetic processing unit 4, the inertia calculation processing is performed for the up / down / count processing output 103 as in the conventional inertial device of FIGS. 4 and 5. In the inertial device 1 of the present embodiment, the external clock cycle measuring circuit 5 measures the repetition cycle of the external clock signal 102, and uses the repetition cycle of the external clock signal 102 as external clock cycle data via the data bus 13. 4 is characterized in that it is supplied to 4.
[0020]
The arithmetic processing unit 4 uses the amount of deviation of the integration time interval indicated by the external clock cycle data from a predetermined external clock cycle (corresponding to the aforementioned reference value) as an error (corresponding to the aforementioned external clock cycle error), and The period of the internal clock obtained by dividing the clock signal 102 is corrected based on the error, and accurate inertia data excluding the influence of the frequency variation of the external clock signal 102 can be obtained.
[0021]
An external clock signal 102 is input to the external clock cycle measuring circuit 5, and a reference clock signal 104, a counter (9) clear signal 107, a counter (10) clear signal 108, a buffer are received from the arithmetic processing unit 4. (11) An enable signal 111 and a buffer (12) enable signal 112 are input. Signals 107, 108, 111 and 112 correspond to the aforementioned control signals. From the external clock cycle measurement circuit 5, external clock cycle data (data configured by alternately selecting the counter (9) count data 109 and the counter (10) count data 110) representing the repetition cycle of the external clock signal 102 is data. The data is output to the arithmetic processing unit 4 via the bus 13.
[0022]
In the arithmetic processing unit 4, as described above, the repetition cycle of the external clock signal 102 is known from the external clock cycle data, and the actual repetition cycle of the external clock signal 102 is shifted from the reference repetition cycle of the external clock signal 102. Is calculated as an external clock signal (102) repetition period error. Then, the arithmetic processing unit 4 generates a corrected external clock by correcting the repetition period of the internal clock obtained by dividing the external clock signal 102 based on the external clock signal (102) repetition period error, and repeats the correction external clock. Inertia data is generated by time integration of the up / down count processing output 103 with the time based on the period. The inertial data obtained by time integration of the up / down count processing output 103 is almost the same as the inertial data obtained by integrating with the repetition period of the reference value when the repetition period of the external clock signal 102 is the reference value. It is accuracy. This inertial data is input to the external connection circuit 6 via the data bus 14 and further transmitted to the external device 16 via the data bus 15.
[0023]
As described above, in the inertia calculation in the calculation processing unit 4, it is possible to obtain the error of the repetition period of the external clock signal 102 and improve the calculation accuracy of the inertia data. In the following, with reference to FIG. 1, FIG. 2 and FIG. 3, the present embodiment will be described focusing on the operation contents of one example of the external clock cycle measuring circuit 5. FIG.
[0024]
As shown in FIG. 1, the external clock signal 102 (see FIG. 3B) output from the external device 16 is input to the up / down counter 3 as described above, and the arithmetic processing unit 4 and It is also input to the external clock cycle measuring circuit 5. A reference clock signal 104 (see FIG. 3A) is supplied from the arithmetic processing unit 4 to the external clock cycle measuring circuit 5, and a counter (9) clear signal 107 (FIG. 3G) is used as a control signal. The counter (10) clear signal 108 (see FIG. 3 (h)), the buffer (11) enable signal 111 (see FIG. 3 (i)) and the buffer (12) enable signal 112 (see FIG. 3 (j)). Is supplied from the arithmetic processing unit 4. The frequency of the external clock signal 102 is 1 kHz. The reference clock signal 104 is generated by a transmitter in the arithmetic processing unit 4 and is a signal having a stable frequency of 10 MHz, and is asynchronous with the external clock signal 102.
[0025]
In FIG. 2, an external clock signal 102 from the external device 16 is input to the latch 7, from which a counter enable signal 105 (corresponding to the first pulse signal described above, see FIG. 3C). The signal is output and input to the counter 9 and is inverted by the inverter 8 to be input to the counter 10 as an inverted counter enable signal 106 (corresponding to the second pulse signal described above, see FIG. 3D). The
[0026]
The counter 9 (corresponding to the above-mentioned first counter) receives the counter enable signal 105 and the reference clock signal 104, and, as shown in FIG. 3 (e), in the period from the timing T1 to T2, The clock signal 104 is counted. The count value in the counter 9 is held as counter (9) count data 109 in a time zone after the timing T2. The counter (9) count data 109 represents the cycle of the external clock signal 102. Similarly, the counter 10 (corresponding to the above-mentioned second counter) receives the inverted counter enable signal 106 and the reference clock signal 104 and receives the timing T2 to T5 as shown in FIG. Until the reference clock signal 104 is counted. The count value in the counter 10 is held as counter (10) count data 110 in a time zone after the timing T5. Similarly to the counter (9) count data 109, the counter (10) count data 110 represents the cycle of the external clock signal 102. The counter (9) count data 109 and the counter (10) count data 110 represent alternating repetition periods in the external clock signal 102, respectively.
[0027]
As shown in FIG. 3 (i), the buffer 11 (corresponding to the first buffer described above) receives the buffer (11) enable signal 111 output from the arithmetic processing unit 4 at timing T3, and receives timing T2 Thereafter, the counter (9) count data 109 held in the counter 9 is fetched. The counter (9) count data 109 is transmitted to the arithmetic processing unit 4 via the buffer 11 and the data bus 13. At the timing T4 after the transfer of the counter (9) count data 109, the counter (9) clear signal 107 is input from the arithmetic processing unit 4 to the counter 9, and the counter (9) count held in the counter 9 is counted. Data 109 is cleared.
[0028]
The series of linkage operations relating to the counter 9 and the buffer 11 is exactly the same for the counter 10 and the buffer 12 (corresponding to the second buffer described above). As shown in FIG. 3 (j), the buffer 12 receives the buffer (12) enable signal 112 output from the arithmetic processing unit 4 at timing T6, and the data is held in the counter 10 after timing T5. The counter (10) count data 110 is taken in, and the counter (10) count data 110 is transmitted to the arithmetic processing unit 4 via the buffer 12 and the data bus 13. At timing T7 after the transfer of the counter (10) count data 110, the counter (10) clear signal 108 is input from the arithmetic processing unit 4 to the counter 10, and the counter (10) count data held in the counter 10 is received. 110 is cleared.
[0029]
FIG. 3 (k) shows a usage time zone of the data bus 13 when the counter (9) count data 109 and the counter (10) count data 110 are transmitted to the external device 16 via the data bus 13, respectively. FIG. In the transmission time zone 13 a corresponding to the buffer (11) enable signal 111 and the buffer (12) enable signal 112, the counter count data 109 and 110 are sequentially transmitted to the arithmetic processing unit 4 via the data bus 13. The counter (9) count data 109 and the counter (10) count data 110 are alternately output to the arithmetic processing unit 4 via the data bus 13 in synchronization with the external clock signal 102. As described above, when the counter count data 109 and 110 are alternately supplied to the arithmetic processing unit 4 via the data bus 13, the arithmetic processing unit 4 uses the data 109 and 110 as integral data as external clock cycle data. recognize. 3K indicates a time zone in which the data bus 13 is in a high impedance state, and a transmission time that can be used for transmission of data signals other than the counter count data 109 and 110. The band is shown.
[0030]
Thus, the external clock cycle measuring circuit 5 in FIG. 2 supplies the external clock cycle data composed of the counter count data 109 and 110 to the arithmetic processing unit 4, and the arithmetic processing unit 4 generates the external clock signal based on the external clock cycle data. An error of 102 repetition periods (external clock period error) is calculated, the repetition period of the external clock signal 102 is corrected based on the external clock period error, a corrected external clock is generated, and based on the repetition period of the corrected external clock Time integration of the up / down count processing output 103 is performed with time. Since the time data in the time integration is accurate, the arithmetic processing unit 4 can calculate accurate inertia data excluding the influence of the error of the repetition period of the external clock signal 102. However, since the reference clock signal 104 is asynchronous with the external clock signal 102, the repetition period of the external clock signal 102 measured by the external clock period measurement circuit 5 has an error of two cycles of the reference clock signal 104 at the maximum. There is. However, in this embodiment, since the reference clock signal 104 is 10 MHz, the error for these two periods is 200 nanoseconds (ns), which is a variation of several tens of microseconds that can occur in the repetition period of the external clock signal 102. Compared to the negligible size.
[0031]
In addition, even if the error of the repetition period of the external clock signal 102 is due to jitter of the repetition period of the external clock signal 102 and the jitter is a relatively large value, in this embodiment, the error of the external clock signal 102 Since the repetition period is measured for each period, even if there is an error based on the jitter in the inertial data obtained by calculation according to the repetition period of the external clock signal 102, accurate inertial data in which the error is corrected Can be output. If the external clock period measurement circuit measures the average value of a plurality of repetition periods in the external clock signal 102, the error of the integral value based on the individual jitter cannot be corrected, but in this embodiment, as described above, Since the repetition period of the external clock signal 102 is measured for each period, an error based on jitter for each repetition period can also be corrected.
[0032]
【The invention's effect】
As described above, according to the present invention, it is possible to provide an inertial device that can supply inertial data synchronized with an external clock signal to an external device with high accuracy even if the cycle of the external clock signal varies.
[Brief description of the drawings]
FIG. 1 is a block diagram showing an embodiment of the present invention.
2 is a configuration diagram showing an example of an external clock period measurement circuit in the embodiment of FIG. 1; FIG.
FIG. 3 is a timing diagram showing signals at various parts in the external clock period measurement circuit of FIG. 2;
FIG. 4 is a block diagram showing a conventional example.
FIG. 5 is a block diagram showing another conventional example.
[Explanation of symbols]
1, 41, 51 Inertial device 2 Inertial sensor 3 Up / down counter 4, 44 Arithmetic processing unit 5 External clock cycle measuring circuit 6 External connection circuit 7 Latch 8 Inverter 9, 10 Counter 11, 12 Buffer 13, 14, 15 Data bus 16 External device 101 Sensor output 102 External clock signal 103 Up / down counter 3 up / down count processing output 104 Reference clock signal 105 Counter enable signal 106 Inverted counter enable signal 107 Counter (9) Clear signal 108 Counter (10) Clear signal 109 Counter (9) Count data 110 Counter (10) Count data 111 Buffer (11) Enable signal 112 Buffer (12) Enable signal 144 Inertial data 402 Clock signal

Claims (4)

移動体の角速度および加速度を検出する慣性センサと、該慣性センサの出力を受ける演算手段とを備え、外部機器から出力される外部クロック信号を該演算手段に受け、該外部クロック信号の繰り返し周期に基づく時間に関し該慣性センサ出力に積分演算処理を施すことにより、該移動体の慣性データを求め、該慣性データを該外部機器へ伝達する慣性装置において、
前記外部クロック信号の繰り返し周期を測定し、該繰り返し周期を表す外部クロック周期データを生成する外部クロック周期測定回路を備え、
前記演算手段は、前記外部クロック周期データを受け、該外部クロック周期データで表される前記繰り返し周期と基準値との差を外部クロック周期誤差として求め、該外部クロック周期誤差に基づき該外部クロックの周期を補正することにより、繰り返し周期の補正された補正外部クロックを生成し、該補正外部クロックの繰り返し周期に基づく時間に関し該慣性センサ出力に積分演算処理を施すことにより、該移動体の慣性データを求め、該慣性データを該外部機器へ伝達する
ことを特徴とする慣性装置。
An inertial sensor for detecting the angular velocity and acceleration of the moving body; and an arithmetic means for receiving an output of the inertial sensor; the arithmetic means receives an external clock signal output from an external device; In an inertial apparatus that obtains inertial data of the moving body by performing integral calculation processing on the output of the inertial sensor with respect to time based on the time, and transmits the inertial data to the external device.
An external clock period measuring circuit for measuring a repetition period of the external clock signal and generating external clock period data representing the repetition period;
The arithmetic means receives the external clock cycle data, obtains a difference between the repetition cycle represented by the external clock cycle data and a reference value as an external clock cycle error, and based on the external clock cycle error, By correcting the cycle, a corrected external clock having a corrected repetition cycle is generated, and the inertial sensor output is subjected to an integral calculation process with respect to the time based on the repetition cycle of the corrected external clock, whereby the inertial data of the moving body is obtained. And inertia data is transmitted to the external device.
前記慣性センサは、前記角速度を検出するジャイロと前記加速度を検出する加速度計とを含み、
前記演算手段は、前記外部クロック信号のタイミングで前記慣性センサ出力にアップダウン・カウント処理を施し、アップダウン・カウント処理出力を生成するアップダウン・カウンタと、該アップダウン・カウント処理出力に積分演算処理を施すことにより前記慣性データを生成する演算処理部でなり、
前記演算処理部は、前記外部クロック周期測定回路の作動を制御する制御信号および基準クロック信号を前記外部クロック周期測定回路へ供給し、
前記基準クロック信号の繰り返し周波数は、前記外部クロック信号の繰り返し周波数より大きく、
前記外部クロック周期測定回路は、前記外部クロック信号の繰り返し周期のパルス幅のパルス信号を生成する外部クロック信号繰り返し周期検出手段と、該パルス幅の時間を前記基準クロック信号で計数する計数手段と、該計数手段から出力される計数値を取り出し、該計数値を前記外部クロック周期データとして前記演算処理部へ送出する手段とを有し、
前記外部クロック信号繰り返し周期検出手段は、前記外部クロック信号における連続する第1及び第2の繰り返し周期をそれぞれ表す第1及び第2のパルス信号を生成し、
前記計数手段は、前記第1及び第2のパルス信号における前記パルス幅を前記基準クロック信号でそれぞれ計数する第1及び第2のカウンタでなり、
前記送出手段は、前記第1及び第2のカウンタの計数値をそれぞれ取り出す第1及び第2のバッファと、該第1及び第2のバッファに取り出された該第1及び第2カウンタの計数値を前記外部クロック周期データとして前記演算処理部へ導くデータバスとでなり、
前記制御信号は、前記計数手段における計数期間並びに前記第1及び第2のバッファによる前記第1及び第2カウンタの計数値の取り出しタイミングを制御することを特徴とする請求項1に記載の慣性装置。
The inertial sensor includes a gyro that detects the angular velocity and an accelerometer that detects the acceleration,
The arithmetic means performs an up / down count process on the inertial sensor output at the timing of the external clock signal, and generates an up / down count process output; and an integral operation on the up / down count process output An arithmetic processing unit that generates the inertial data by performing processing,
The arithmetic processing unit supplies a control signal and a reference clock signal for controlling the operation of the external clock cycle measuring circuit to the external clock cycle measuring circuit,
The repetition frequency of the reference clock signal is greater than the repetition frequency of the external clock signal,
The external clock period measuring circuit includes an external clock signal repetition period detecting means for generating a pulse signal having a pulse width of a repetition period of the external clock signal, a counting means for counting the time of the pulse width with the reference clock signal, Taking out the count value output from the counting means, and sending the count value as the external clock cycle data to the arithmetic processing unit,
The external clock signal repetition period detecting means generates first and second pulse signals respectively representing first and second repetition periods that are continuous in the external clock signal;
The counting means includes first and second counters for counting the pulse widths in the first and second pulse signals with the reference clock signal, respectively.
The sending means includes first and second buffers that respectively extract count values of the first and second counters, and count values of the first and second counters that are extracted to the first and second buffers. A data bus that leads to the arithmetic processing unit as the external clock cycle data,
2. The inertial device according to claim 1, wherein the control signal controls a counting period in the counting unit and a timing of taking out count values of the first and second counters by the first and second buffers. 3. .
前記外部クロック信号繰り返し周期検出手段は、前記外部クロック信号をラッチして、該外部クロック信号に同期し、且つ外部クロック信号の各周期ごとに交互にハイレベル及びロウレベルに切り替わるパルス信号を前記第1のパルス信号として生成するラッチと、該第1のパルス信号の極性を反転して、前記第2のパルス信号を生成するインバータとでなる
ことを特徴とする請求項2に記載の慣性装置。
The external clock signal repetition period detecting means latches the external clock signal, synchronizes with the external clock signal, and generates a pulse signal that alternately switches between a high level and a low level for each period of the external clock signal. The inertial device according to claim 2, comprising: a latch that generates the first pulse signal, and an inverter that generates the second pulse signal by inverting the polarity of the first pulse signal.
前記補正外部クロックは、前記外部クロックを分周した内部クロックの繰り返し周期を前記外部クロック周期誤差に基づき補正したクロックであることを特徴とする請求項1乃至3に記載の慣性装置。4. The inertial device according to claim 1, wherein the corrected external clock is a clock obtained by correcting a repetition cycle of an internal clock obtained by dividing the external clock based on the external clock cycle error.
JP2001389770A 2001-12-21 2001-12-21 Inertial device Expired - Lifetime JP3776795B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2001389770A JP3776795B2 (en) 2001-12-21 2001-12-21 Inertial device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2001389770A JP3776795B2 (en) 2001-12-21 2001-12-21 Inertial device

Publications (2)

Publication Number Publication Date
JP2003185465A JP2003185465A (en) 2003-07-03
JP3776795B2 true JP3776795B2 (en) 2006-05-17

Family

ID=27597891

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2001389770A Expired - Lifetime JP3776795B2 (en) 2001-12-21 2001-12-21 Inertial device

Country Status (1)

Country Link
JP (1) JP3776795B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015163359A1 (en) * 2014-04-24 2015-10-29 シャープ株式会社 Electric milling machine

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7117086B2 (en) * 2003-09-08 2006-10-03 Honeywell International Inc. GPS/IMU clock synchronization particularly for deep integration vector tracking loop
CN112729284B (en) * 2020-12-22 2023-06-27 重庆华渝电气集团有限公司 Strapdown inertial navigation resolving signal and external system clock synchronization method
CN114485726A (en) * 2021-12-23 2022-05-13 北京无线电测量研究所 Inertial navigation pulse output sampler manufacturing method and system

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015163359A1 (en) * 2014-04-24 2015-10-29 シャープ株式会社 Electric milling machine
JP2015208394A (en) * 2014-04-24 2015-11-24 シャープ株式会社 Electric mill
CN105980061A (en) * 2014-04-24 2016-09-28 夏普株式会社 Electric milling machine

Also Published As

Publication number Publication date
JP2003185465A (en) 2003-07-03

Similar Documents

Publication Publication Date Title
US7379480B2 (en) Fast frequency adjustment method for synchronizing network clocks
KR102048083B1 (en) Synchronization mechanism for high speed sensor interface
CN110017836B (en) Accelerometer digital sampling sliding window filtering cross-clock domain synchronous data transmission method
JPS60131465A (en) Detector for rotating speed
CN105319567B (en) A kind of laser gyro position attitude system method for synchronizing time
JP3776795B2 (en) Inertial device
CN110879298B (en) Speed acquisition method based on communication type encoder
JPS6229028B2 (en)
JP4059698B2 (en) Inertial device
US20210231427A1 (en) Information processing apparatus, non-transitory computer-readable storage medium having stored therein information processing program, information processing system, and information processing method
CN113834970B (en) Frequency measuring device, microcontroller, and electronic apparatus
US20130346022A1 (en) Physical quantity measuring apparatus and physical quantity measuring method
KR20110082678A (en) Time syncronization method between radio vibration measuring systems using revision signal
CN114812544A (en) Measurement information asynchronous processing method for loosely-coupled navigation
US11964390B2 (en) Counter unit, counter unit control method, control device, and control system
JP6504822B2 (en) Speed measuring device and moving object
JPH061279B2 (en) Digital speed detector
KR101315640B1 (en) Anemometer and measuring method of wind velocity using ultrasonic
US20240264195A1 (en) Ultrasonic time measurement device, and ultrasonic time measurement method
JP2018059887A (en) Space distance calculation device
JPH04273737A (en) Time synchronizing device for lan
JPH10239019A (en) Moving body position measuring device
JP4759829B2 (en) Flow measuring device
JPH05248882A (en) Inertia device
JPS63175789A (en) Distance measuring instrument

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040413

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20060213

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20060221

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20060223

R150 Certificate of patent or registration of utility model

Ref document number: 3776795

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100303

Year of fee payment: 4

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110303

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120303

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120303

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120303

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120303

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130303

Year of fee payment: 7

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130303

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130303

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140303

Year of fee payment: 8

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

EXPY Cancellation because of completion of term