JP2009008632A - レート検出装置およびこのレート検出装置を搭載した飛しょう体 - Google Patents
レート検出装置およびこのレート検出装置を搭載した飛しょう体 Download PDFInfo
- Publication number
- JP2009008632A JP2009008632A JP2007172663A JP2007172663A JP2009008632A JP 2009008632 A JP2009008632 A JP 2009008632A JP 2007172663 A JP2007172663 A JP 2007172663A JP 2007172663 A JP2007172663 A JP 2007172663A JP 2009008632 A JP2009008632 A JP 2009008632A
- Authority
- JP
- Japan
- Prior art keywords
- rate
- axis
- inclination
- detection
- rate sensor
- 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.)
- Pending
Links
Images
Landscapes
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
【課題】レートセンサが保持具に取り付けられる際に、レートセンサの検出軸の方向が、所要の方向に向いていない場合にも、検出軸周りの角速度を高精度に検出でき、生産性を向上させることのできるレート検出装置を提供すること。
【解決手段】レート検出装置10は、検出軸Xのレートを検出するレートセンサ13と、検出軸傾き補正部14およびレート算出部15を具備する。検出軸傾き補正部14は、検出軸X上に配置したレートセンサ13の傾きを所要の行列式αにより求めたレートセンサ傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値α3を得る。
【選択図】 図2
【解決手段】レート検出装置10は、検出軸Xのレートを検出するレートセンサ13と、検出軸傾き補正部14およびレート算出部15を具備する。検出軸傾き補正部14は、検出軸X上に配置したレートセンサ13の傾きを所要の行列式αにより求めたレートセンサ傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値α3を得る。
【選択図】 図2
Description
本発明は、飛しょう体に搭載され、この飛しょう体の角速度を検出するレートセンサを用いたレート検出装置およびこのレート検出装置を搭載した飛しょう体に係わるもので、特に飛しょう体に搭載して用いるに適するレート検出装置およびこのレート検出装置を用いるに適する飛しょう体に関する。
従来、レートセンサには、一般的に機械式、流体式、光学式等があり、また機械式には、回転型、振動型等がある。このレートセンサを用いたレート検出装置は、飛しょう体または地上を走行する車両等の移動体に搭載され、検出された角速度を用いて、飛しょう体または地上を走行する車両等の移動体の姿勢制御等の目的に供される。
レート検出装置は、飛しょう体に搭載する場合、一般的に3軸(ピッチ軸、ヨー軸およびロール軸)に対して、各軸周りの角速度を検出できるようになっている。
レート検出装置を飛しょう体または地上を走行する車両等の移動体に搭載した場合には、移動体の発生する振動を受けることになり、これに対応し得たレートセンサを用いる必要がある。
車両に適用された種々のレート検出装置の中には、例えばレートセンサによりヨーレートおよびピッチレートを検出し、特に車両のピッチ方向への傾斜角を算出することでヨーレートの補正をなし、車両の姿勢安定性を図ったものがある(例えば、特許文献1参照)。
図4に示す従来のヨーレート検出装置は、車両本体(図示せず)に車両用ナビゲーションシステムの1つとして、ジャイロセンサ1と、加速度センサ2と、測距部3と、傾斜角算出部4および角速度補正部5とを備えている。
ジャイロセンサ1は、車両に対して水平に取り付けられ、車両のヨー方向への角速度が検出されるようになっている。加速度センサ2は、自身の検出軸が車両の進行方向への加速度を検出するように設けられる。測距部3は、図示しない車速パルス発生装置から車速パルスを取得して車両の移動距離Dを算出するようになっている。傾斜角算出部4は、ジャイロセンサ1の出力値(角速度)rと、加速度センサ2の出力値gと、測距部3で算出された移動距離Dを使って、水平面に対するピッチ方向への車両の傾斜角度を、ピッチ角θとして算出できるようになっている。
また、角速度補正部5は、ジャイロセンサから、車両のヨー方向周りの出力値rを受け取る。更に角速度補正部5は、傾斜角算出部4で算出されたピッチ角θを使って、受け取った出力値rを、鉛直軸周りの出力値r´に補正することができるようになっている。
走行による車両の加速度の他に、重力加速度が働く。さらに、旋回時、車両には遠心加速度も働く。そして、傾斜角算出部4で車両の進行方向への加速度を求め、ピッチ角θを算出する。次に、角速度補正部5は、出力値r´に基づく補正値が得られる。この補正値に基づく補正の結果、車両がピッチ方向に傾斜する面上を走行中でも、常に鉛直軸周りの正確な出力値r´が得られるようになっている。従って、常に車両の正確な方位が得られるようになっている。
特開2005−140627号公報
しかしながら、レート検出装置は、被取付体、例えば飛しょう体の機体軸に対して、レートセンサの検出軸が微小に傾いて取り付けられてしまう。この状況下では、飛しょう体が機体軸に垂直な他の軸周りに回転した場合に、レートセンサが機体軸の回転(角速度)として誤検出してしまい、姿勢制御を誤ってしまう可能性がある。特に、レート検出装置を飛しょう体に採用した場合には、レート検出装置の構成品およびレート検出装置が搭載される飛しょう体構成品の機械精度および組立精度を上げることで対処していたが、この場合レートセンサ検出軸と飛しょう体機体軸との平行度を所望の範囲内に収めるため、構成品のコスト増およびレート検出装置の組立調整工数増となり、レート検出装置の生産性低下を伴っていた。
本発明は、上記の事情に鑑みてなされたもので、レートセンサが保持具に取り付けられる際に、レートセンサの検出軸の方向が、所要の方向に向いていない場合にでも、検出軸周りの角速度を高精度に検出でき、生産性を向上させることのできるレート検出装置を提供することを主な目的とする。
また、本発明の他の目的は、レートセンサの検出軸が、飛しょう体方向の機体軸に対して平行に設置されていない場合にも、飛しょう体の進行方向の角速度を高精度に検出でき、生産性を向上させることのできるレート検出装置を搭載した飛しょう体を提供することにある。
上記目的を達成するために、本発明によれば、検出軸のレートを検出するレートセンサと、検出軸傾き補正部およびレート算出部を具備したレート検出装置であって、前記検出軸傾き補正部は、各軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値が得られるようにしたことを特徴とするレート検出装置を提供する。
上記目的を達成するために、本発明によれば、3軸の方向を検出軸として形成するX軸、Y軸およびZ軸上にレート(角速度)を検出するレートセンサを備えたレート検出装置を搭載した飛しょう体であって、前記レート検出装置は、各軸のレートを検出するレートセンサと、検出軸傾き補正部およびレート算出部を備え、前記検出軸傾き補正部は、各軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値が得られるようにしたことを特徴とするレート検出装置を搭載した飛しょう体を提供する。
本発明のレート検出装置によれば、レートセンサの検出軸が飛しょう体の機体軸に対して厳密に平行でなくてもよく、この傾きを予め測定し、得られた検出角速度をレートセンサ傾きベクトルにより補正することにより、飛しょう体の機体軸周りの正確な角速度を得ることが可能となる。従って、レート検出装置の構成品およびレート検出装置が搭載される飛しょう体構成品の機械精度および組立精度を緩和することができ、レート検出装置の生産性を向上させることができる。
また、3軸の方向を検出軸として形成するX軸、Y軸およびZ軸上にレート(角速度)を検出するレートセンサを備えたレート検出装置を搭載した飛しょう体であって、演算処理装置を利用して検出軸傾き補正値を得るようにしたことにより、レートセンサ検出軸と飛しょう体機体軸との平行度を所望の範囲内に収める必要がなく、構成品のコスト低減やレート検出装置の組立調整工数低減化が図れ、レート検出装置の生産性を向上することができるレート検出装置を搭載した飛しょう体を提供することができる。
本発明に係わるレート検出装置の実施形態について、添付図面を参照して説明する。
図1は、本発明のレート検出装置のレートセンサを飛しょう体の筒状胴体部に内設した状態を示す要部断面図である。
図1に示すレート検出装置10は、飛しょう体の、例えば筒状胴体11の内部に設けられ、レートセンサの検出軸が、飛しょう体のロール軸、すなわち飛しょう体の進行方向と平行となるように板状の保持具12に設けられる。
また、ロール軸に対し他の2軸である図示しないピッチ軸およびヨー軸にも設けられるが、同様構成であるのでヨー軸である抽出軸Xのレートを検出する1つのレート検出装置10について説明する。
レート検出装置10のレートセンサ13を保持するために保持具12が設けられる。この保持具12は、飛しょう体の進行方向に面部12aが面するように配設される。この保持具12の面部12aにレート検出装置10が取り付けられることにより、レートセンサ13が飛しょう体の機体軸に沿う進行方向に向かって設けられ、所要のレート(角速度)が検出可能になっている。
図2は、レート検出装置10の実施形態を示すブロック図である。
レート検出装置10は、図2に示すように、レートセンサ13、検出軸傾き補正部14およびレート算出部15を備えている。検出軸傾き補正部14およびレート算出部15は、図示しない、例えばターゲット捕捉手段の演算制御部に設けたり、あるいは独自に設けられる検出軸傾き補正部14の演算制御部に設けるようにしてもよい。
レート検出装置10のレートセンサ13は、図1に示すように、保持具12の飛しょう体の進行方向側の面部12a側に取り付けられる。検出軸傾き補正部14更にはレート算出部15を独自に設ける場合には、保持具12の残余の面上に別個に取り付けてもよい。
検出軸傾き補正部14は、レート検出装置10が予め筒状胴体11に取り付けられた状態で、ロール軸レートの特性を、図3に示す行列式αにより、補正値α3を求める。すなわち、図3に示す行列式αは、係数群α1と、レートセンサの実測検出値α2とを乗算することにより補正値α3を求めることができる。
この図3に示す補正値α3の求め方について更に詳述する。図3は、レート検出装置10の検出軸傾き補正部14における補正値計算を示す。
係数群α1は、レート検出装置10のレートセンサの、飛しょう体機体軸に対する検出軸の傾き特性を係数とした行列である。実測検出値α2は、ロール軸、ピッチ軸およびヨー軸各々のレートセンサの検出値である。
従って、補正値α3は、係数群α1に実測検出値α2を乗算することにより得られる値であって、固有のレート検出装置10の保持具12の面部12aが機体軸に対して、保持具12の面部12aの平面方向が、図1のY´に示すように機体軸に直交する方向から僅かにずれていた場合、更には、保持具12の面部12aが精度よく機体軸に直交する方向に向かって取り付けられているが、レートセンサ13の向きが正しく取り付けられていなかった場合であっても、上記の補正値α3をあるべき姿として、飛翔体の実際の角速度により、真に検出されるべき値として求めることができる。
また、検出軸傾き補正部14は、記憶部14aおよび演算処理部14bが設けられる。記憶部14aは、レートセンサ13の傾きであるレートセンサ傾きベクトルを係数群α1に置き換えパラメータとして記憶する。
実測検出値α2は、レート検出装置10を飛しょう体に搭載した状態でのレートセンサ検出値である。
演算処理部14bは、係数群α1を実測検出値α2に乗算し補正値α3を得るための演算処理機能を有する。レート算出部15は、検出軸傾き補正部14で求めた補正値α3を、レート値Rとして変換する。
次に、レート検出装置10の作用を、飛しょう体のヨー方向である検出軸Xの方向にレートセンサ13の正面方向が、例えば図1において、X´軸の方向に設置された場合について説明する。
レート検出装置10が設置された飛しょう体は、飛しょうするに先だって、先ずレート検出装置10の複数の所要部位の特性を示す係数群α1を求める。この所要部位の特性については、レート検出装置10の性能をチェックするについて、複数の部位における、例えば性能の保持に欠かせないチェックポイントデータを得る。
次に、飛しょう体の飛行中においてレート検出装置10を作動させると、レートセンサ13が作動して、飛しょう体の回転に基づく角速度に応じた所定の検出値α2である電圧を起成して、検出軸傾き補正部14へ出力する。次に、検出軸傾き補正部14が電圧α2を受けることにより、レート検出装置10の記憶部14aから係数群α1を呼び出し、演算処理部14bで、レートセンサ13の補正値α3である所定の電圧を生起してレート算出部15に出力する。この補正値α3を入力したレート算出部15で、補正値α3をレート値Rに変換され、飛しょう体の制御装置側へ出力される。
飛しょう体の姿勢制御装置は、当該飛しょう体の進行方向である機体軸(検出軸X方向)の正確なレートに応じた飛しょう体の姿勢制御を行うことができる。
従って、レート検出装置10が飛しょう体に設置された状態で、レート検出装置10の保持具12の表面12aが機体軸に対して、例え正面を向いていなくても、更には、保持具12の表面12a上にレートセンサ13が正しく取り付けられていなかったとしても、飛しょう体の進行方向におけるロール軸周りの飛しょう体の角速度を正確に得ることができるので、飛しょう体の姿勢制御に用いることができる。
なお、上述したレート検出装置10は、飛しょう体の進行方向であるロール軸方向に設置した場合を説明したが、ピッチ軸方向およびヨー軸方向にもレート検出装置10と同様のレート検出装置10が設置される。
10 レート検出装置
11 筒状胴体
12 保持具
12a,12b 面部
13 レートセンサ
14 検出軸傾き補正部
14a 記憶部
14b 演算処理部
15 レート算出部
α 行列式
α1 係数群(行列)
α2 実測検出値(電圧)
α3 補正値(電圧)
R レート値
11 筒状胴体
12 保持具
12a,12b 面部
13 レートセンサ
14 検出軸傾き補正部
14a 記憶部
14b 演算処理部
15 レート算出部
α 行列式
α1 係数群(行列)
α2 実測検出値(電圧)
α3 補正値(電圧)
R レート値
Claims (4)
- 検出軸のレートを検出するレートセンサと、検出軸傾き補正部およびレート算出部を具備したレート検出装置であって、
前記検出軸傾き補正部は、各軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値が得られるようにしたことを特徴とするレート検出装置。 - 前記検出軸傾き補正部は、前記検出軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、パラメータとして記憶する記憶部および演算処理装置を備え、
前記演算処理装置は、前記記憶部に記憶されたパラメータにより実測検出値を演算し、補正値を得るようにしたことを特徴とする請求項1記載のレート検出装置。 - 3軸の方向を検出軸として形成するX軸、Y軸およびZ軸上にレート(角速度)を検出するレートセンサを備えたレート検出装置を搭載した飛しょう体であって、
前記レート検出装置は、各軸のレートを検出するレートセンサと、検出軸傾き補正部およびレート算出部を備え、
前記検出軸傾き補正部は、各軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、実測検出値に乗算して補正値が得られるようにしたことを特徴とするレート検出装置を搭載した飛しょう体。 - 前記検出軸傾き補正部は、前記検出軸に配置したレートセンサの傾きであるレートセンサ傾きベクトルを、パラメータとして記憶する記憶部および演算処理装置を備え、
前記演算処理装置は、前記記憶部に記憶されたパラメータにより実測検出値を演算し、補正値を得るようにしたことを特徴とする請求項3記載のレート検出装置を搭載した飛しょう体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007172663A JP2009008632A (ja) | 2007-06-29 | 2007-06-29 | レート検出装置およびこのレート検出装置を搭載した飛しょう体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007172663A JP2009008632A (ja) | 2007-06-29 | 2007-06-29 | レート検出装置およびこのレート検出装置を搭載した飛しょう体 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2009008632A true JP2009008632A (ja) | 2009-01-15 |
Family
ID=40323844
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007172663A Pending JP2009008632A (ja) | 2007-06-29 | 2007-06-29 | レート検出装置およびこのレート検出装置を搭載した飛しょう体 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2009008632A (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013253939A (ja) * | 2012-06-08 | 2013-12-19 | Seiko Epson Corp | センサーユニット並びに電子機器および運動体 |
CN105953770A (zh) * | 2016-07-13 | 2016-09-21 | 北京机械设备研究所 | 一种发射筒倾角动态测量装置 |
-
2007
- 2007-06-29 JP JP2007172663A patent/JP2009008632A/ja active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013253939A (ja) * | 2012-06-08 | 2013-12-19 | Seiko Epson Corp | センサーユニット並びに電子機器および運動体 |
US9523702B2 (en) | 2012-06-08 | 2016-12-20 | Seiko Epson Corporation | Sensor unit, electronic device, and moving body |
CN105953770A (zh) * | 2016-07-13 | 2016-09-21 | 北京机械设备研究所 | 一种发射筒倾角动态测量装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9857198B2 (en) | Apparatus and method for inertial sensor calibration | |
US8200452B2 (en) | Attitude-angle detecting apparatus and attitude-angle detecting method | |
JP5043358B2 (ja) | 傾斜角演算方法及び傾斜角演算装置 | |
EP3093619B1 (en) | Multi-axis center of mass balancing system for an optical gimbal assembly guided by inertial measurement | |
JP4673314B2 (ja) | 角速度センサユニット及び角速度センサ診断装置 | |
US10101174B2 (en) | Air data aided inertial measurement unit | |
JP2009002735A (ja) | 角速度検出装置 | |
JP6383907B2 (ja) | 車輌位置計測装置及び方法 | |
JP6604175B2 (ja) | ピッチ角速度補正値算出装置、姿勢角算出装置およびピッチ角速度補正値算出方法 | |
JP2019194559A (ja) | 慣性支援を使用する光大気データ補償システム | |
WO2019202072A1 (en) | A radar apparatus for a vehicle and method of detecting misalignment | |
CN111895967A (zh) | 一种旋转角度传感器 | |
EP3335010B1 (en) | Inertial sensor | |
JP2009008632A (ja) | レート検出装置およびこのレート検出装置を搭載した飛しょう体 | |
CN109677508A (zh) | 一种车辆运动数据获取方法、装置、设备和存储介质 | |
JP2007107951A (ja) | 取付け角度算出装置 | |
KR20140138635A (ko) | 관성 센서 향상 | |
JP2005147696A (ja) | 取り付け角度算出装置 | |
US9671248B2 (en) | Method for calibrating an inertial navigation system with a limited mechanical turning range | |
JP2843903B2 (ja) | 慣性航法装置 | |
JP6409625B2 (ja) | 車両位置算出装置 | |
JP6632727B2 (ja) | 角度計測装置 | |
JP6454857B2 (ja) | 姿勢検出装置及び姿勢検出方法 | |
JP2012141219A (ja) | 傾斜角検出装置、方法、プログラムおよび記録媒体 | |
CN111356901A (zh) | 检测未对准 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20100426 |