(57)【要約】【課題】レートセンサが保持具に取り付けられる際に、レートセンサの検出軸の方向が、所要の方向に向いていない場合にも、検出軸周りの角速度を高精度に検出でき、生産性を向上させることのできるレート検出装置を提供すること。【解決手段】レート検出装置１０は、検出軸Ｘのレートを検出するレートセンサ１３と、検出軸傾き補正部１４およびレート算出部１５を具備する。検出軸傾き補正部１４は、検出軸Ｘ上に配置したレートセンサ１３の傾きを所要の行列式αにより求めたレートセンサ傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値α３を得る。【選択図】  図２
2009008632.tif 000002
【特許請求の範囲】
【請求項１】
検出軸のレートを検出するレートセンサと、検出軸傾き補正部およびレート算出部を具備したレート検出装置であって、
前記検出軸傾き補正部は、各軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値が得られるようにしたことを特徴とするレート検出装置。
【請求項２】
前記検出軸傾き補正部は、前記検出軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、パラメータとして記憶する記憶部および演算処理装置を備え、
前記演算処理装置は、前記記憶部に記憶されたパラメータにより実測検出値を演算し、補正値を得るようにしたことを特徴とする請求項１記載のレート検出装置。
【請求項３】
３軸の方向を検出軸として形成するＸ軸、Ｙ軸およびＺ軸上にレート（角速度）を検出するレートセンサを備えたレート検出装置を搭載した飛しょう体であって、
前記レート検出装置は、各軸のレートを検出するレートセンサと、検出軸傾き補正部およびレート算出部を備え、
前記検出軸傾き補正部は、各軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値が得られるようにしたことを特徴とするレート検出装置を搭載した飛しょう体。
【請求項４】
前記検出軸傾き補正部は、前記検出軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、パラメータとして記憶する記憶部および演算処理装置を備え、
前記演算処理装置は、前記記憶部に記憶されたパラメータにより実測検出値を演算し、補正値を得るようにしたことを特徴とする請求項３記載のレート検出装置を搭載した飛しょう体。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、飛しょう体に搭載され、この飛しょう体の角速度を検出するレートセンサを用いたレート検出装置およびこのレート検出装置を搭載した飛しょう体に係わるもので、特に飛しょう体に搭載して用いるに適するレート検出装置およびこのレート検出装置を用いるに適する飛しょう体に関する。
【背景技術】
【０００２】
従来、レートセンサには、一般的に機械式、流体式、光学式等があり、また機械式には、回転型、振動型等がある。このレートセンサを用いたレート検出装置は、飛しょう体または地上を走行する車両等の移動体に搭載され、検出された角速度を用いて、飛しょう体または地上を走行する車両等の移動体の姿勢制御等の目的に供される。
【０００３】
レート検出装置は、飛しょう体に搭載する場合、一般的に３軸（ピッチ軸、ヨー軸およびロール軸）に対して、各軸周りの角速度を検出できるようになっている。
【０００４】
レート検出装置を飛しょう体または地上を走行する車両等の移動体に搭載した場合には、移動体の発生する振動を受けることになり、これに対応し得たレートセンサを用いる必要がある。
【０００５】
車両に適用された種々のレート検出装置の中には、例えばレートセンサによりヨーレートおよびピッチレートを検出し、特に車両のピッチ方向への傾斜角を算出することでヨーレートの補正をなし、車両の姿勢安定性を図ったものがある（例えば、特許文献１参照）。
【０００６】
図４に示す従来のヨーレート検出装置は、車両本体（図示せず）に車両用ナビゲーションシステムの１つとして、ジャイロセンサ１と、加速度センサ２と、測距部３と、傾斜角算出部４および角速度補正部５とを備えている。
【０００７】
ジャイロセンサ１は、車両に対して水平に取り付けられ、車両のヨー方向への角速度が検出されるようになっている。加速度センサ２は、自身の検出軸が車両の進行方向への加速度を検出するように設けられる。測距部３は、図示しない車速パルス発生装置から車速パルスを取得して車両の移動距離Ｄを算出するようになっている。傾斜角算出部４は、ジャイロセンサ１の出力値（角速度）ｒと、加速度センサ２の出力値ｇと、測距部３で算出された移動距離Ｄを使って、水平面に対するピッチ方向への車両の傾斜角度を、ピッチ角θとして算出できるようになっている。
【０００８】
また、角速度補正部５は、ジャイロセンサから、車両のヨー方向周りの出力値ｒを受け取る。更に角速度補正部５は、傾斜角算出部４で算出されたピッチ角θを使って、受け取った出力値ｒを、鉛直軸周りの出力値ｒ´に補正することができるようになっている。
【０００９】
走行による車両の加速度の他に、重力加速度が働く。さらに、旋回時、車両には遠心加速度も働く。そして、傾斜角算出部４で車両の進行方向への加速度を求め、ピッチ角θを算出する。次に、角速度補正部５は、出力値ｒ´に基づく補正値が得られる。この補正値に基づく補正の結果、車両がピッチ方向に傾斜する面上を走行中でも、常に鉛直軸周りの正確な出力値ｒ´が得られるようになっている。従って、常に車両の正確な方位が得られるようになっている。
【特許文献１】特開２００５−１４０６２７号公報
【発明の開示】
【発明が解決しようとする課題】
【００１０】
しかしながら、レート検出装置は、被取付体、例えば飛しょう体の機体軸に対して、レートセンサの検出軸が微小に傾いて取り付けられてしまう。この状況下では、飛しょう体が機体軸に垂直な他の軸周りに回転した場合に、レートセンサが機体軸の回転（角速度）として誤検出してしまい、姿勢制御を誤ってしまう可能性がある。特に、レート検出装置を飛しょう体に採用した場合には、レート検出装置の構成品およびレート検出装置が搭載される飛しょう体構成品の機械精度および組立精度を上げることで対処していたが、この場合レートセンサ検出軸と飛しょう体機体軸との平行度を所望の範囲内に収めるため、構成品のコスト増およびレート検出装置の組立調整工数増となり、レート検出装置の生産性低下を伴っていた。
【００１１】
本発明は、上記の事情に鑑みてなされたもので、レートセンサが保持具に取り付けられる際に、レートセンサの検出軸の方向が、所要の方向に向いていない場合にでも、検出軸周りの角速度を高精度に検出でき、生産性を向上させることのできるレート検出装置を提供することを主な目的とする。
【００１２】
また、本発明の他の目的は、レートセンサの検出軸が、飛しょう体方向の機体軸に対して平行に設置されていない場合にも、飛しょう体の進行方向の角速度を高精度に検出でき、生産性を向上させることのできるレート検出装置を搭載した飛しょう体を提供することにある。
【課題を解決するための手段】
【００１３】
上記目的を達成するために、本発明によれば、検出軸のレートを検出するレートセンサと、検出軸傾き補正部およびレート算出部を具備したレート検出装置であって、前記検出軸傾き補正部は、各軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値が得られるようにしたことを特徴とするレート検出装置を提供する。
【００１４】
上記目的を達成するために、本発明によれば、３軸の方向を検出軸として形成するＸ軸、Ｙ軸およびＺ軸上にレート（角速度）を検出するレートセンサを備えたレート検出装置を搭載した飛しょう体であって、前記レート検出装置は、各軸のレートを検出するレートセンサと、検出軸傾き補正部およびレート算出部を備え、前記検出軸傾き補正部は、各軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値が得られるようにしたことを特徴とするレート検出装置を搭載した飛しょう体を提供する。
【発明の効果】
【００１５】
本発明のレート検出装置によれば、レートセンサの検出軸が飛しょう体の機体軸に対して厳密に平行でなくてもよく、この傾きを予め測定し、得られた検出角速度をレートセンサ傾きベクトルにより補正することにより、飛しょう体の機体軸周りの正確な角速度を得ることが可能となる。従って、レート検出装置の構成品およびレート検出装置が搭載される飛しょう体構成品の機械精度および組立精度を緩和することができ、レート検出装置の生産性を向上させることができる。
【００１６】
また、３軸の方向を検出軸として形成するＸ軸、Ｙ軸およびＺ軸上にレート（角速度）を検出するレートセンサを備えたレート検出装置を搭載した飛しょう体であって、演算処理装置を利用して検出軸傾き補正値を得るようにしたことにより、レートセンサ検出軸と飛しょう体機体軸との平行度を所望の範囲内に収める必要がなく、構成品のコスト低減やレート検出装置の組立調整工数低減化が図れ、レート検出装置の生産性を向上することができるレート検出装置を搭載した飛しょう体を提供することができる。
【発明を実施するための最良の形態】
【００１７】
本発明に係わるレート検出装置の実施形態について、添付図面を参照して説明する。
【００１８】
図１は、本発明のレート検出装置のレートセンサを飛しょう体の筒状胴体部に内設した状態を示す要部断面図である。
【００１９】
図１に示すレート検出装置１０は、飛しょう体の、例えば筒状胴体１１の内部に設けられ、レートセンサの検出軸が、飛しょう体のロール軸、すなわち飛しょう体の進行方向と平行となるように板状の保持具１２に設けられる。
【００２０】
また、ロール軸に対し他の２軸である図示しないピッチ軸およびヨー軸にも設けられるが、同様構成であるのでヨー軸である抽出軸Ｘのレートを検出する１つのレート検出装置１０について説明する。
【００２１】
レート検出装置１０のレートセンサ１３を保持するために保持具１２が設けられる。この保持具１２は、飛しょう体の進行方向に面部１２ａが面するように配設される。この保持具１２の面部１２ａにレート検出装置１０が取り付けられることにより、レートセンサ１３が飛しょう体の機体軸に沿う進行方向に向かって設けられ、所要のレート（角速度）が検出可能になっている。
【００２２】
図２は、レート検出装置１０の実施形態を示すブロック図である。
【００２３】
レート検出装置１０は、図２に示すように、レートセンサ１３、検出軸傾き補正部１４およびレート算出部１５を備えている。検出軸傾き補正部１４およびレート算出部１５は、図示しない、例えばターゲット捕捉手段の演算制御部に設けたり、あるいは独自に設けられる検出軸傾き補正部１４の演算制御部に設けるようにしてもよい。
【００２４】
レート検出装置１０のレートセンサ１３は、図１に示すように、保持具１２の飛しょう体の進行方向側の面部１２ａ側に取り付けられる。検出軸傾き補正部１４更にはレート算出部１５を独自に設ける場合には、保持具１２の残余の面上に別個に取り付けてもよい。
【００２５】
検出軸傾き補正部１４は、レート検出装置１０が予め筒状胴体１１に取り付けられた状態で、ロール軸レートの特性を、図３に示す行列式αにより、補正値α３を求める。すなわち、図３に示す行列式αは、係数群α１と、レートセンサの実測検出値α２とを乗算することにより補正値α３を求めることができる。
【００２６】
この図３に示す補正値α３の求め方について更に詳述する。図３は、レート検出装置１０の検出軸傾き補正部１４における補正値計算を示す。
【００２７】
係数群α１は、レート検出装置１０のレートセンサの、飛しょう体機体軸に対する検出軸の傾き特性を係数とした行列である。実測検出値α２は、ロール軸、ピッチ軸およびヨー軸各々のレートセンサの検出値である。
【００２８】
従って、補正値α３は、係数群α１に実測検出値α２を乗算することにより得られる値であって、固有のレート検出装置１０の保持具１２の面部１２ａが機体軸に対して、保持具１２の面部１２ａの平面方向が、図１のＹ´に示すように機体軸に直交する方向から僅かにずれていた場合、更には、保持具１２の面部１２ａが精度よく機体軸に直交する方向に向かって取り付けられているが、レートセンサ１３の向きが正しく取り付けられていなかった場合であっても、上記の補正値α３をあるべき姿として、飛翔体の実際の角速度により、真に検出されるべき値として求めることができる。
【００２９】
また、検出軸傾き補正部１４は、記憶部１４ａおよび演算処理部１４ｂが設けられる。記憶部１４ａは、レートセンサ１３の傾きであるレートセンサ傾きベクトルを係数群α１に置き換えパラメータとして記憶する。
【００３０】
実測検出値α２は、レート検出装置１０を飛しょう体に搭載した状態でのレートセンサ検出値である。
【００３１】
演算処理部１４ｂは、係数群α１を実測検出値α２に乗算し補正値α３を得るための演算処理機能を有する。レート算出部１５は、検出軸傾き補正部１４で求めた補正値α３を、レート値Ｒとして変換する。
【００３２】
次に、レート検出装置１０の作用を、飛しょう体のヨー方向である検出軸Ｘの方向にレートセンサ１３の正面方向が、例えば図１において、Ｘ´軸の方向に設置された場合について説明する。
【００３３】
レート検出装置１０が設置された飛しょう体は、飛しょうするに先だって、先ずレート検出装置１０の複数の所要部位の特性を示す係数群α１を求める。この所要部位の特性については、レート検出装置１０の性能をチェックするについて、複数の部位における、例えば性能の保持に欠かせないチェックポイントデータを得る。
【００３４】
次に、飛しょう体の飛行中においてレート検出装置１０を作動させると、レートセンサ１３が作動して、飛しょう体の回転に基づく角速度に応じた所定の検出値α２である電圧を起成して、検出軸傾き補正部１４へ出力する。次に、検出軸傾き補正部１４が電圧α２を受けることにより、レート検出装置１０の記憶部１４ａから係数群α１を呼び出し、演算処理部１４ｂで、レートセンサ１３の補正値α３である所定の電圧を生起してレート算出部１５に出力する。この補正値α３を入力したレート算出部１５で、補正値α３をレート値Ｒに変換され、飛しょう体の制御装置側へ出力される。
【００３５】
飛しょう体の姿勢制御装置は、当該飛しょう体の進行方向である機体軸（検出軸Ｘ方向）の正確なレートに応じた飛しょう体の姿勢制御を行うことができる。
【００３６】
従って、レート検出装置１０が飛しょう体に設置された状態で、レート検出装置１０の保持具１２の表面１２ａが機体軸に対して、例え正面を向いていなくても、更には、保持具１２の表面１２ａ上にレートセンサ１３が正しく取り付けられていなかったとしても、飛しょう体の進行方向におけるロール軸周りの飛しょう体の角速度を正確に得ることができるので、飛しょう体の姿勢制御に用いることができる。
【００３７】
なお、上述したレート検出装置１０は、飛しょう体の進行方向であるロール軸方向に設置した場合を説明したが、ピッチ軸方向およびヨー軸方向にもレート検出装置１０と同様のレート検出装置１０が設置される。
【図面の簡単な説明】
【００３８】
【図１】本発明のレート検出装置のレートセンサを飛しょう体の筒状胴体部に内設した状態を示す要部断面図。
【図２】本発明のレート検出装置の実施形態を示すブロック図。
【図３】本発明のレート検出装置の検出軸傾き補正部における補正値計算を示す図。
【図４】従来のレート検出装置の全体構成を示すブロック図。
【符号の説明】
【００３９】
１０  レート検出装置
１１  筒状胴体
１２  保持具
１２ａ，１２ｂ  面部
１３  レートセンサ
１４  検出軸傾き補正部
１４ａ  記憶部
１４ｂ  演算処理部
１５  レート算出部
α  行列式
α１  係数群（行列）
α２  実測検出値（電圧）
α３  補正値（電圧）
Ｒ  レート値
【図１】
2009008632.tif 000003
【図２】
2009008632.tif 000004
【図３】
2009008632.tif 000005
【図４】
2009008632.tif 000006