JPH0587585A - Atitude detector by strapdown system - Google Patents

Atitude detector by strapdown system

Info

Publication number
JPH0587585A
JPH0587585A JP24760391A JP24760391A JPH0587585A JP H0587585 A JPH0587585 A JP H0587585A JP 24760391 A JP24760391 A JP 24760391A JP 24760391 A JP24760391 A JP 24760391A JP H0587585 A JPH0587585 A JP H0587585A
Authority
JP
Japan
Prior art keywords
axis
gyro
signal
azimuth
acceleration
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.)
Granted
Application number
JP24760391A
Other languages
Japanese (ja)
Other versions
JP3038452B2 (en
Inventor
Fuyuki Hane
冬希 羽根
Takeshi Hojo
武 北條
Tsurashi Yamamoto
貫志 山本
Shinichi Nakamura
慎一 中村
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.)
Tokyo Keiki Inc
Original Assignee
Tokimec Inc
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 Tokimec Inc filed Critical Tokimec Inc
Priority to JP3247603A priority Critical patent/JP3038452B2/en
Publication of JPH0587585A publication Critical patent/JPH0587585A/en
Application granted granted Critical
Publication of JP3038452B2 publication Critical patent/JP3038452B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Navigation (AREA)

Abstract

PURPOSE:To simplify the constitution and maintain detection accuracy by constituting of two gyros, two accelerometers and a magnet azimuth detector. CONSTITUTION:From a sensor block part 1' to an operator 2', X, Y acceleration signals AX, AY from X, Y accelectrometers 11A, 12A, X, Y gyro signals GX, GY from X, Y gyros 11G, 12G and azimuth signal H from a magnet azimuth detector 13Y' are sent. In the operator 2', by using the signal H in a coordinates corrector 30 and a Z gyro calculator 31, an equivalent Z gyro signal GZ and corrected azimuth signal HC are obtained. Also by using signals AX, AY in a Z acceleration operator 40, an equivalent Z acceleration signal Az is obtained so that a posture angle transmission role angle signal ROL, a pitch angle signal PIT and an azimuth signal YAW are calculated. X, Y gyro bias signals Bx, By included in the signals GX, GY are estimated by operation in a gyro bias operator 50 and is subtracted from the signals GX, GY in a gyro bias correction part 51.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、ジャイロ、加速度計及
び磁気方位検出器を用いたストラップダウン方式による
姿勢検出装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a strapdown type attitude detection device using a gyro, an accelerometer and a magnetic direction detector.

【0002】[0002]

【従来の技術】従来のストラップダウン方式の姿勢検出
装置として図5及び図6に示す如きのものが提案されて
いる。図5は、従来のストラップダウン方式の姿勢検出
装置の一例の全体を示すブロック図で、このストラップ
ダウン方式の姿勢検出装置はセンサブロック部1と演算
部2より成る。図5のセンサブロック部1は、右手直交
3軸座標系と一致する取付軸10(図5では、Z軸方向
を下向垂直方向とし、図中の矢印は各センサの検出量の
(+)の入力方向を示している。)において、X軸に
は、X軸方向の加速度を検出するX加速度計11AとX
軸まわりの角速度を検出するXジャイロ11Gとが取付
けられ、Y軸には、Y軸方向の加速度を検出するY加速
度計12AとY軸まわりの角速度を検出するYジャイロ
12Gとが取付けられ、Z軸には、Z軸方向の加速度を
検出するZ加速度計13AとZ軸まわりの角速度を検出
するZジャイロ13Gと重力加速度方向の垂直軸まわり
の方位角を検出する磁気方位検出器13Yとが取付けら
れている。このセンサブロック部1のこの各3軸の加速
度計11A、12A、13A、3軸のジャイロ11G、
12G、13G及び磁気方位検出器13Yからの出力信
号は、演算部2に入力する。その演算部2において、こ
の入力信号を用いて演算して、センサブロック部1の取
付軸10のロール角信号ROL、ピッチ角信号PIT及
び方位角信号YAWを姿勢発信角として出力する。
2. Description of the Related Art As a conventional strap-down type posture detecting device, one shown in FIGS. 5 and 6 has been proposed. FIG. 5 is a block diagram showing an entire example of a conventional strapdown-type posture detection device. This strapdown-type posture detection device includes a sensor block unit 1 and a calculation unit 2. The sensor block unit 1 of FIG. 5 has a mounting shaft 10 that matches the right-handed orthogonal three-axis coordinate system (in FIG. 5, the Z-axis direction is the downward vertical direction, and the arrow in the figure indicates the detection amount of each sensor (+)). Input direction of X), the X accelerometers 11A and X for detecting acceleration in the X axis direction are provided on the X axis.
An X gyro 11G that detects an angular velocity around the axis is attached, and a Y accelerometer 12A that detects an acceleration in the Y axis direction and a Y gyro 12G that detects an angular velocity about the Y axis are attached to the Y axis. A Z accelerometer 13A for detecting acceleration in the Z axis direction, a Z gyro 13G for detecting angular velocity around the Z axis, and a magnetic azimuth detector 13Y for detecting azimuth angle around the vertical axis in the direction of gravity acceleration are attached to the axis. Has been. The three-axis accelerometers 11A, 12A, 13A and the three-axis gyro 11G of the sensor block unit 1,
Output signals from the 12G and 13G and the magnetic azimuth detector 13Y are input to the arithmetic unit 2. The calculation unit 2 calculates using this input signal and outputs the roll angle signal ROL, the pitch angle signal PIT, and the azimuth angle signal YAW of the mounting shaft 10 of the sensor block unit 1 as the attitude transmission angle.

【0003】図6は、図5の演算部2の一例の構成を示
すブロック図である。このセンサブロック部1の3軸の
ジャイロ11G、12G、13Gの出力信号は、Xジャ
イロ信号GX、Yジャイロ信号GY、Zジャイロ信号G
Z(以降、この3つのジャイロ信号をGiと記す場合も
ある)として演算部2のCTM演算部20に入力され
る。このCTM演算部20において、入力されたジャイ
ロ信号Giを用いてこの取付軸10の座標系から、局地
座標系(X軸方向が北方向で、かつZ軸方向が重力方向
に一致している座標系)に変換する3×3行列を演算す
る。
FIG. 6 is a block diagram showing the configuration of an example of the arithmetic unit 2 of FIG. The output signals of the three-axis gyros 11G, 12G, and 13G of the sensor block unit 1 are X gyro signal GX, Y gyro signal GY, and Z gyro signal G.
It is input to the CTM arithmetic unit 20 of the arithmetic unit 2 as Z (hereinafter, these three gyro signals may be referred to as Gi). In the CTM calculation unit 20, the input gyro signal Gi is used to change the coordinate system of the mounting shaft 10 from the local coordinate system (the X-axis direction is the north direction and the Z-axis direction is the gravity direction). A 3 × 3 matrix to be converted into a coordinate system) is calculated.

【0004】さらに、この3×3行列の要素により、局
地座標系に対する姿勢角をX軸に関してロール角信号R
OL、Y軸に関してピッチ角信号PIT及びZ軸に関し
て方位角信号YAWを演算して、演算部2の出力とす
る。しかしながら、CTM演算部20で演算した3×3
行列には、演算する際に用いた3×3行列の初期値とセ
ンサブロック部1の取付軸10の初期値との差等により
姿勢角の誤差が生じている。このCTM演算部20に生
じた姿勢角の誤差の水平成分については水平演算部21
と起立演算部22とを用いて修正する。
Furthermore, the attitude angle with respect to the local coordinate system is calculated by the elements of this 3 × 3 matrix, and the roll angle signal R with respect to the X axis is used.
The pitch angle signal PIT for the OL and Y axes and the azimuth angle signal YAW for the Z axis are calculated and output as the output of the calculation unit 2. However, 3 × 3 calculated by the CTM calculator 20
The matrix has an error in the posture angle due to the difference between the initial value of the 3 × 3 matrix used in the calculation and the initial value of the mounting shaft 10 of the sensor block unit 1. Regarding the horizontal component of the attitude angle error generated in the CTM calculation unit 20, the horizontal calculation unit 21
And the upright calculation unit 22 are used for correction.

【0005】CTM演算部20から3×3の行列信号C
TMSと、このセンサブロック部1の3軸の加速度計1
1A、12A、13Aの出力信号は、X加速度信号A
X、Y加速信号AY、Z加速度信号AZ(以降、3つの
加速度信号をAiと記す場合もある)として、演算部2
の水平演算部21に入力される。この水平演算部21に
おいて、入力された3つの加速度信号Aiと行列信号C
TMSとを用いて、この局地座標系に対する姿勢角誤差
のX軸方向姿勢角誤差ERRX及びY軸方向姿勢角誤差
ERRYを演算し、出力する。この姿勢角誤差ERR
X、ERRYは、起立演算部22に入力される。起立演
算部22においてCTM演算部20のX軸修正信号CX
とY軸修正信号CYとを入力された姿勢角誤差ERR
X、ERRYを用いて演算し、出力する。
A 3 × 3 matrix signal C from the CTM calculator 20
TMS and 3-axis accelerometer 1 of this sensor block 1
The output signals of 1A, 12A, and 13A are X acceleration signals A
As the X, Y acceleration signals AY, Z acceleration signals AZ (hereinafter, the three acceleration signals may be referred to as Ai), the calculation unit 2
Is input to the horizontal calculation unit 21. In the horizontal calculation unit 21, the three input acceleration signals Ai and matrix signals C
Using TMS, the X-axis direction attitude angle error ERRX and the Y-axis direction attitude angle error ERRY of the attitude angle error with respect to this local coordinate system are calculated and output. This attitude angle error ERR
X and ERRY are input to the standing up calculation unit 22. In the upright operation unit 22, the X-axis correction signal CX of the CTM operation unit 20
And the Y-axis correction signal CY
It is calculated using X and ERRY and output.

【0006】また、このCTM演算部20に生じた姿勢
角の誤差の垂直成分については、方位演算部23を用い
て修正する。方位演算部23において、このセンサブロ
ック部1のZ軸に取付けられた方位検出器13Yの出力
信号は、方位信号Hとして演算部2を介して入力される
一方、このCTM演算部20で演算され、出力された方
位角信号YAWも入力され、入力された方位信号Hと方
位角信号YAWとを用いて、CTM演算部20のZ軸修
正信号CZを演算し、出力する。このX軸修正信号C
X、Y軸修正信号CY及びZ軸修正信号CZは、CTM
演算部20に入力されて、姿勢角の誤差を修正するルー
プが構成される。
Further, the vertical component of the error of the attitude angle generated in the CTM calculating section 20 is corrected by using the azimuth calculating section 23. In the azimuth calculation unit 23, the output signal of the azimuth detector 13Y attached to the Z-axis of the sensor block unit 1 is input as the azimuth signal H via the calculation unit 2 and is calculated in the CTM calculation unit 20. The output azimuth signal YAW is also input, and the Z-axis correction signal CZ of the CTM calculator 20 is calculated and output using the input azimuth signal H and azimuth signal YAW. This X-axis correction signal C
X, Y axis correction signal CY and Z axis correction signal CZ are CTM
A loop that is input to the arithmetic unit 20 and corrects an error in the attitude angle is configured.

【0007】さらに具体的にセンサブロック部1の取付
軸10の初期値と演算部2のCTM演算部20の初期値
に差がある場合、最終的に姿勢角発信に含まれる誤差が
なくなる理由について述べる。このときの取付軸10
は、局地座標系に対して、Z軸まわりにγO 回転し、次
にY軸まわりにβO 回転し、最後にX軸まわりにαO
転していて、CTM演算部20の初期値は、局地座標系
と一致しているとする。このときの加速度信号Aiは近
似的に次式で表される。
More specifically, when there is a difference between the initial value of the mounting shaft 10 of the sensor block unit 1 and the initial value of the CTM calculation unit 20 of the calculation unit 2, the reason why the error included in the attitude angle transmission finally disappears is explained. State. Mounting shaft 10 at this time
Is rotated γ O around the Z axis, then β O around the Y axis, and finally α O around the X axis with respect to the local coordinate system. Is assumed to match the local coordinate system. The acceleration signal Ai at this time is approximately represented by the following equation.

【0008】[0008]

【数1】 [Equation 1]

【0009】ここで、gは重力加速度、TO は3×3行
列であり、数2で示す如くである。
[0009] Here, g is the gravitational acceleration, T O is 3 × 3 matrix, is as shown by the number 2.

【0010】[0010]

【数2】 [Equation 2]

【0011】ここで、αO 、βO 、γO は、取付軸10
の局地座標系に対する微小角である。また、CTM演算
部20の行列信号CTMSの初期値は、次式である。
Here, α O , β O , and γ O are the mounting shaft 10
It is a small angle with respect to the local coordinate system of. The initial value of the matrix signal CTMS of the CTM calculator 20 is given by the following equation.

【0012】[0012]

【数3】 [Equation 3]

【0013】水平演算部21において、局地座標系の
X、Y軸方向の誤差角を演算するために、入力された行
列信号CTMSと加速度信号Aiとを次式のように掛算
する。
In the horizontal calculation section 21, in order to calculate the error angle in the X and Y axis directions of the local coordinate system, the input matrix signal CTMS and acceleration signal Ai are multiplied by the following equation.

【0014】[0014]

【数4】 [Equation 4]

【0015】ここで、ERRiはX、Y.Z軸の誤差角
である。この数4の内、X軸の誤差角は、−βO gとし
て、Y軸の誤差角はαO gとして検出される。水平演算
部21で検出した水平成分の誤差角ERRX、ERRY
は、起立演算部22に入力される。起立演算部22にお
いて、入力された誤差角ERRX、ERRYを用いて、
次式の演算を行った後、X軸修正信号CXとY軸修正信
号CYとして出力される。
Here, ERRi is X, Y. This is the error angle of the Z axis. In this equation 4, the X-axis error angle is detected as −β O g and the Y-axis error angle is detected as α O g. Error angles ERRX and ERRY of horizontal components detected by the horizontal calculation unit 21
Is input to the stand-up calculator 22. In the stand-up calculation unit 22, using the input error angles ERRX and ERRY,
After the calculation of the following equation, the X-axis correction signal CX and the Y-axis correction signal CY are output.

【0016】[0016]

【数5】 [Equation 5]

【0017】[0017]

【数6】 [Equation 6]

【0018】ここで、μは、比例ゲインである。取付軸
10のZ軸に取り付けられている磁気方位検出器13Y
から出力された方位信号Hと、CTM演算部20より発
信した方位角信号YAWとが、方位演算部23に入力さ
れる。所で、取付軸10のZ軸に取付られている磁気方
位検出器13Yは、重力加速度方向の垂直軸まわりの方
位を検出するので、この方位は、局地座標系に対する方
位角信号YAWと同じ座標系になっている。
Here, μ is a proportional gain. Magnetic azimuth detector 13Y attached to the Z-axis of the attachment shaft 10
The azimuth signal H output from the CTM calculator 20 and the azimuth angle signal YAW transmitted from the CTM calculator 20 are input to the azimuth calculator 23. Since the magnetic azimuth detector 13Y attached to the Z axis of the attachment shaft 10 detects the azimuth around the vertical axis of the gravitational acceleration direction, this azimuth is the same as the azimuth signal YAW for the local coordinate system. It has a coordinate system.

【0019】方位演算部23において、方位信号Hと方
位角信号YAWとは次式の様に演算されて、Z軸修正信
号CZを求める。
In the azimuth calculation unit 23, the azimuth signal H and the azimuth angle signal YAW are calculated by the following equation to obtain the Z-axis correction signal CZ.

【0020】[0020]

【数7】 [Equation 7]

【0021】[0021]

【数8】 [Equation 8]

【0022】[0022]

【数9】 ここで、τは、方位時定数である。[Equation 9] Here, τ is an azimuth time constant.

【0023】X軸修正信号CXは、数5より、Y軸修正
信号CYは、数6より及びZ軸修正信号は数9より得ら
れ、CTM演算部20に入力される。CTM演算部20
において、入力された3軸の修正信号CX、CY及びC
Zを用いて、修正行列CTMCを作り、修正行列CTM
CとCTM信号CTMSとを用いて、次式の演算を行う
ことで、姿勢角の誤差を修正することができる。
The X-axis correction signal CX is obtained from Eq. 5, the Y-axis correction signal CY is obtained from Eq. 6, and the Z-axis correction signal is obtained from Eq. CTM calculator 20
, The input correction signals CX, CY and C of the three axes
Z is used to create a modified matrix CTMC, and the modified matrix CTM
By using the C and the CTM signal CTMS, the calculation of the following equation can be performed to correct the attitude angle error.

【0024】[0024]

【数10】 [Equation 10]

【0025】ここで、tは、現在の時刻を表し、Δt
は、時間更新の間隔を表し、(t+Δt)は、現在の時
刻tから次の時刻(t+Δt)を表し、(t,Δt)
は、時刻t、時刻t+Δt間での変化量を表わす。
Here, t represents the present time, and Δt
Represents the time update interval, (t + Δt) represents the next time (t + Δt) from the current time t, and (t, Δt)
Represents the amount of change between time t and time t + Δt.

【0026】[0026]

【数11】 [Equation 11]

【0027】数11は離散型の行列で記述されているの
で、微分方程式の形に新ためて書き直すと、姿勢角の誤
差は次式のようになる。
Since the equation 11 is described by a discrete matrix, if the equation is newly rewritten in the form of the differential equation, the error of the attitude angle is as follows.

【0028】[0028]

【数12】 [Equation 12]

【0029】よって、数12を解けば、Therefore, if the equation 12 is solved,

【0030】[0030]

【数13】 [Equation 13]

【0031】ここで、添字Oは、初期値を表わす。従っ
て数11の修正をCTM演算部20で行ったとき、行列
信号CTMSに含まれた姿勢角誤差は、数13で表さ
れ、その定常値は零となり、CTM演算部20からの姿
勢角(ロール角ROL、ピッチ角PIT及び方位角YA
W)に含まれる取付軸の初期値とCTM演算部20の初
期値との差による誤差による成分は最終的にはなくな
り、その姿勢角は、取付軸10の局地座標系に対する値
となる。次に、CTM演算部20において、入力された
3軸のジャイロ信号Giを用いて、取付軸10の座標系
から局地座標系に変換する3×3の座標変換行列の演算
する方法について説明する。3軸のジャイロ信号Giは
時間(t,t+Δt)で角速度を積分した角度である。
式で表せば、
Here, the subscript O represents an initial value. Therefore, when the CTM calculation unit 20 corrects the formula 11, the posture angle error included in the matrix signal CTMS is represented by the formula 13, and its steady value becomes zero, and the posture angle (roll Angle ROL, pitch angle PIT and azimuth YA
The component due to the error due to the difference between the initial value of the mounting axis included in W) and the initial value of the CTM calculator 20 finally disappears, and the attitude angle becomes a value with respect to the local coordinate system of the mounting axis 10. Next, a method of calculating a 3 × 3 coordinate conversion matrix for converting the coordinate system of the mounting axis 10 into the local coordinate system by using the input 3-axis gyro signal Gi in the CTM calculator 20 will be described. .. The 3-axis gyro signal Gi is an angle obtained by integrating the angular velocity over time (t, t + Δt).
Expressed as a formula,

【0032】[0032]

【数14】 [Equation 14]

【0033】ここで、ωiは、X軸、Y軸及びZ軸ジャ
イロが検出した角速度である。3軸のジャイロ信号Gi
は、間隔Δtでの変化量であり、この変化量を間隔Δt
毎に次式のように累積することにより、座標変換行列を
求める。すなわち、
Here, ωi is the angular velocity detected by the X-axis, Y-axis and Z-axis gyros. 3-axis gyro signal Gi
Is the change amount at the interval Δt, and this change amount is calculated as the interval Δt.
The coordinate transformation matrix is obtained by accumulating each time as in the following equation. That is,

【0034】[0034]

【数15】 [Equation 15]

【0035】ここで、CTMSは、3×3の座標変換行
列Γ(t,Δt)は、時間〔t,t+Δt〕で変化した
角度行列で、
Here, CTMS is a 3 × 3 coordinate transformation matrix Γ (t, Δt), which is an angle matrix changed in time [t, t + Δt],

【0036】[0036]

【数16】 [Equation 16]

【0037】t=0のとき、CTMS(0)は初期値で
あり、数3より
When t = 0, CTMS (0) is an initial value, and from Equation 3,

【0038】[0038]

【数17】 となる。[Equation 17] Becomes

【0039】実際は、数15のΓ(t,Δt)と前述し
た数10のCTM(t,Δt)との演算が、CTM演算
部20において実行される。新ためて、その演算を記述
すると、次式となる。
In practice, the calculation of Γ (t, Δt) of equation 15 and CTM (t, Δt) of equation 10 described above is executed in the CTM arithmetic unit 20. Newly, the operation is described as follows.

【0040】[0040]

【数18】 [Equation 18]

【0041】また、CTM演算部20から発信するロー
ル角信号ROL、ピッチ角信号PIT及び方位角信号Y
AWの演算する方法は次のとおりである。最初、座標変
換行列の座標軸を局地座標軸と一致させておき、Z軸ま
わりに方位角φ回転させ、次にY軸まわりにピッチ角θ
回転させ、最後にロール角φ回転させたときの3×3の
座標変換行列CTMSは次式となる。
Further, the roll angle signal ROL, the pitch angle signal PIT, and the azimuth angle signal Y transmitted from the CTM calculator 20.
The method of calculating the AW is as follows. First, the coordinate axes of the coordinate transformation matrix are made to coincide with the local coordinate axes, the azimuth angle φ is rotated about the Z axis, and then the pitch angle θ is rotated about the Y axis.
The 3 × 3 coordinate transformation matrix CTMS when rotated and finally rotated by the roll angle φ is as follows.

【0042】[0042]

【数19】 [Formula 19]

【0043】従って、数19より姿勢角発信信号は、そ
れぞれ次式となる。
Therefore, the posture angle transmission signals are given by the following equations from the equation (19).

【0044】[0044]

【数20】 [Equation 20]

【0045】[0045]

【発明が解決しようとする課題】しかしながら、上述の
従来の装置は、3つのジャイロと3つの加速度計を用い
て、ストラップダウン方式を構成しているために、セン
サブロック部1の取付機構部が複雑になり、重量の軽減
化、小型化に際して制約が伴う不都合があった。さらに
重大なことは、ジャイロと加速度計の価格が装置自体の
価格の大部分を支えるために、従来の装置では価格の低
減化を容易に計れない不都合があった。また、使用する
ジャイロは、温度変化、振動等に対してドリフト変化が
極めて少ないものでなければ、そのドリフト変化により
姿勢角発信に誤差が含まれてしまう不都合があった。本
発明は斯る点に鑑み上述不都合を改善した新規なストラ
ップダウン方式の姿勢検出装置を提供せんとするもので
ある。
However, in the above-mentioned conventional device, since the strap-down system is constituted by using three gyros and three accelerometers, the mounting mechanism portion of the sensor block portion 1 is There is a problem in that it becomes complicated, and there are restrictions in weight reduction and size reduction. More importantly, since the price of the gyro and the accelerometer supports most of the price of the device itself, there is an inconvenience that the conventional device cannot easily reduce the price. Further, if the gyro used does not have a very small drift change due to temperature change, vibration, etc., there is a disadvantage that the posture change transmission includes an error due to the drift change. In view of this point, the present invention is to provide a novel strap-down type posture detection device that has improved the above-mentioned inconvenience.

【0046】[0046]

【課題を解決するための手段】本発明ストラップダウン
方式の姿勢検出装置は例えば図1、図2に示す如く、右
手直交3軸座標0−XYZと一致する取付軸において、
そのX軸には、X軸方向の加速度を検出するX加速度計
11AとX軸のまわりの角速度を検出するXジャイロ1
1Gとが取付けられ、そのY軸には、Y軸方向の加速度
を検出するY加速度計12AとY軸まわりの角速度を検
出するYジャイロ12Gとが取付けられ、そのZ軸に
は、Z軸まわりの方位角を検出する磁気方位検出器13
Y′が取付けられたセンサブロック部1′と、このセン
サブロック部1′のX及びY加速度計11A及び12A
から出力されるX及びY加速度信号、このX及びYジャ
イロ11G及び12Gから出力されるX及びYジャイロ
信号、そしてこの磁気方位検出器13Y′から出力され
る方位信号を入力し、姿勢角、ロール角信号、ピッチ角
信号そして方位角信号を演算して、発信する演算部2′
とより構成されたものである。
As shown in FIGS. 1 and 2, for example, as shown in FIGS. 1 and 2, a strap-down type posture detecting device according to the present invention has a right-handed orthogonal triaxial coordinate 0-XYZ in a mounting shaft,
An X accelerometer 11A for detecting acceleration in the X axis direction and an X gyro 1 for detecting angular velocity around the X axis are provided on the X axis.
1G is attached, a Y accelerometer 12A for detecting acceleration in the Y-axis direction and a Y gyro 12G for detecting angular velocity around the Y-axis are attached to the Y-axis, and a Z-axis is attached to the Y-axis. Magnetic azimuth detector 13 for detecting the azimuth angle of
A sensor block portion 1'on which Y'is attached, and X and Y accelerometers 11A and 12A of this sensor block portion 1 '.
The X and Y acceleration signals output from the X and Y gyros 11G and 12G, and the azimuth signal output from the magnetic azimuth detector 13Y 'are input, and the attitude angle and roll are input. A calculation unit 2'which calculates and transmits an angle signal, a pitch angle signal and an azimuth signal.
It is composed of

【0047】また本発明ストラップダウン方式の姿勢検
出装置は、例えば図1、図2に示す如く上述において、
演算部2′に重力加速度方向の垂直軸まわりの方位角を
演算する機能、取付軸のZ軸まわりの角速度を演算する
機能、このZ軸方向の加速度を演算する機能、このX及
びYジャイロ信号に含まれるX及びYジャイロバイアス
成分を推定演算する機能及び、X及びYジャイロバイア
ス成分を除去する機能を設け、X及びY加速度計11A
及び12A、X及びYジャイロ11G及び12Gのおの
おの2個ずつを用いたストラップダウン方式の演算がで
きるようにしたものである。
Further, the strap-down type posture detecting device of the present invention is, for example, as described above with reference to FIGS.
The function of calculating the azimuth angle about the vertical axis in the direction of gravity acceleration, the function of calculating the angular velocity of the mounting axis about the Z axis, the function of calculating the acceleration in the Z axis direction, the X and Y gyro signals. Is provided with a function of estimating and calculating the X and Y gyro bias components and a function of removing the X and Y gyro bias components.
And 12A, X and Y gyros 11G and 12G, respectively, so that the strap-down method can be used.

【0048】[0048]

【作用】本発明によればX及びY加速度計11A及び1
2Aから出力されるX及びY加速度信号とX及びYジャ
イロ11G及び12Gから出力されるX及びYジャイロ
信号と磁気方位検出器13Y′から出力される方位信号
とより姿勢角、ロール角信号、ピッチ角信号及び方位角
信号を得るようにしているので、2個のジャイロ11
G、12G、2個の加速度計11A、12A及び磁気方
位検出器13Y′の構成で従来と同様の精度の姿勢検出
装置を得ることができる。
In accordance with the present invention, X and Y accelerometers 11A and 1
Attitude angle, roll angle signal, pitch based on X and Y acceleration signals output from 2A, X and Y gyro signals output from X and Y gyros 11G and 12G, and azimuth signals output from magnetic azimuth detector 13Y '. Since the angle signal and the azimuth signal are obtained, the two gyros 11
With the configuration of G, 12G, the two accelerometers 11A and 12A, and the magnetic azimuth detector 13Y ', it is possible to obtain the attitude detecting device with the same accuracy as the conventional one.

【0049】また本発明によれば使用するジャイロのバ
イアス成分を推定し、除去する機能を有するので、振動
ジャイロ、ガスレートジャイロ等の比較的小型で、安価
なジャイロを使用できる。
Further, according to the present invention, since it has a function of estimating and removing the bias component of the gyro to be used, a relatively small and inexpensive gyro such as a vibration gyro or a gas rate gyro can be used.

【0050】[0050]

【実施例】以下、図1及び図2を参照して本発明ストラ
ップダウン方式の姿勢検出装置の一実施例を説明する。
この図1及び図2において図5及び図6に対応する部分
には同一符号を付し、これらの説明は省略する。図1例
において、図5の従来例と異なる点は従来のセンサブロ
ック部1の取付軸10のZ軸に取付けられていたZ加速
度計13AとZジャイロ13Gが本例のセンサブロック
部1′の取付軸10のZ軸から取り除かれ、重力加速度
方向の垂直軸まわりの方位角を検出する磁気方位検出器
13Yのかわりに、取付軸10のZ軸まわりの方位角を
検出する磁気方位検出器13Y′にかわったことと、図
5の従来例と異なる点は、演算部2′において、座標修
正部30、Zジャイロ演算部31、Z加速度演算部4
0、ジャイロバイアス演算部50及びジャイロバイアス
修正部51が、新たに設けられていることである。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENT An embodiment of the strap-down type posture detecting device of the present invention will be described below with reference to FIGS.
In FIGS. 1 and 2, parts corresponding to those in FIGS. 5 and 6 are designated by the same reference numerals, and description thereof will be omitted. 1 is different from the conventional example of FIG. 5 in that a Z accelerometer 13A and a Z gyro 13G, which are attached to the Z axis of the attachment shaft 10 of the conventional sensor block section 1, are included in the sensor block section 1'of this example. A magnetic azimuth detector 13Y, which is removed from the Z axis of the mounting shaft 10 and detects the azimuth angle of the mounting shaft 10 around the Z axis, instead of the magnetic azimuth detector 13Y that detects the azimuth angle around the vertical axis of the gravitational acceleration direction. 5 is different from the conventional example of FIG. 5 in that in the calculation unit 2 ′, the coordinate correction unit 30, the Z gyro calculation unit 31, and the Z acceleration calculation unit 4 are included.
0, a gyro bias calculation unit 50, and a gyro bias correction unit 51 are newly provided.

【0051】図1において、右手直交3軸座標系と一致
する取付軸10に対してそのX軸には、X軸方向の加速
度を検出するX加速度計11AとX軸まわりの角速度を
検出するXジャイロ11Gとが取付られ、そのY軸に
は、Y軸方向の加速度を検出するY加速度計12AとY
軸まわりの角速度を検出するYジャイロとが取付られ、
そしてZ軸には、Z軸まわりの方位角を検出する磁気方
位検出器13Y′が取付けられたセンサブロック部1′
から演算部2′にこのX加速度計11AからのX加速度
信号AX、Y加速度計12AからY加速度信号AY、X
ジャイロ11GからのXジャイロ信号GX、Yジャイロ
12GからのYジャイロ信号GYそして磁気方位検出器
13Y′からの方位信号H′が供給される。この演算部
2′に供給されたX加速度信号AX、Y加速度信号A
Y、Xジャイロ信号GX、Yジャイロ信号GYそして方
位信号H′を用いて、演算し、センサブロック部1′の
取付軸10の姿勢角、ロール角信号ROL、ピッチ角信
号PIT及び方位角信号YAWを姿勢発信角として出力
する。本例のより詳細な動作について図2、図3及び図
4を用いて説明する。
In FIG. 1, an X accelerometer 11A for detecting an acceleration in the X axis direction and an X for detecting an angular velocity around the X axis are provided on the X axis of the mounting axis 10 which coincides with the right-handed orthogonal three-axis coordinate system. A gyro 11G is attached, and a Y accelerometer 12A and a Y accelerometer 12A for detecting acceleration in the Y axis direction are attached to the Y axis.
A Y gyro that detects the angular velocity around the axis is attached,
The Z-axis is a sensor block unit 1'where a magnetic azimuth detector 13Y 'for detecting the azimuth angle around the Z-axis is attached.
From the X acceleration signal AX from the X accelerometer 11A and the Y acceleration signal AY, X from the Y accelerometer 12A.
The X gyro signal GX from the gyro 11G, the Y gyro signal GY from the Y gyro 12G, and the azimuth signal H'from the magnetic azimuth detector 13Y 'are supplied. The X acceleration signal AX and the Y acceleration signal A supplied to the calculation unit 2 '
The Y, X gyro signal GX, the Y gyro signal GY, and the azimuth signal H'are used for calculation, and the posture angle of the mounting shaft 10 of the sensor block unit 1 ', the roll angle signal ROL, the pitch angle signal PIT, and the azimuth signal YAW are calculated. Is output as the attitude transmission angle. A more detailed operation of this example will be described with reference to FIGS. 2, 3, and 4.

【0052】図2は、本例の演算部2′のブロック図で
ある。この演算部2′において、CTM演算部20、水
平演算部21及び起立演算部22の動作は図6と同一な
ので省略し、新たに設けられた座標修正部30、Zジャ
イロ演算部31、Z加速度演算部40、ジャイロバイア
ス演算部50及びジャイロバイアス修正部51の動作に
ついて説明する。座標修正部30において、入力された
方位角信号H′とCTM演算部から入力されたロール角
信号ROL、ピッチ角信号PITとを用いて、局地座標
系の方位角の修正方位信号HCと、取付軸10の座標系
の方位相当信号Hzとを演算し、出力する。この座標修
正部30の演算は、次式である。
FIG. 2 is a block diagram of the arithmetic unit 2'of this example. In the calculation unit 2 ', the operations of the CTM calculation unit 20, the horizontal calculation unit 21, and the stand-up calculation unit 22 are the same as those in FIG. 6, and therefore the description thereof will be omitted, and the newly provided coordinate correction unit 30, Z gyro calculation unit 31, and Z acceleration. The operations of the calculation unit 40, the gyro bias calculation unit 50, and the gyro bias correction unit 51 will be described. The coordinate correction unit 30 uses the input azimuth angle signal H ′ and the roll angle signal ROL and pitch angle signal PIT input from the CTM calculation unit, and the corrected azimuth signal HC of the azimuth angle of the local coordinate system, An azimuth equivalent signal Hz of the coordinate system of the mounting shaft 10 is calculated and output. The calculation of the coordinate correction unit 30 is the following formula.

【0053】[0053]

【数21】 [Equation 21]

【0054】[0054]

【数22】 [Equation 22]

【0055】ここで、f1 、f2 は、かっこ内の変数に
依存する関数である。この修正信号HCは、方位演算部
23に出力され、方位相当信号Hzは、Zジャイロ演算
部31に出力される。Zジャイロ演算部31において、
入力された方位相当信号Hzを用いて、等価Zジャイロ
信号Gz′を演算してCTM演算部20に出力する。こ
の等価Zジャイロ信号Gz′は、1回前の方位相当信号
Hz(t−Δt)と現在の方位相当信号Hz(t)との
差分を求めることで得られる。よって、この等価Zジャ
イロ信号Gz′は、次式で示される。
Here, f 1 and f 2 are functions depending on the variables in the parentheses. The correction signal HC is output to the azimuth calculation unit 23, and the azimuth equivalent signal Hz is output to the Z gyro calculation unit 31. In the Z gyro operation unit 31,
The equivalent Z gyro signal Gz ′ is calculated using the input azimuth equivalent signal Hz and output to the CTM calculator 20. This equivalent Z gyro signal Gz 'is obtained by obtaining the difference between the previous azimuth equivalent signal Hz (t-Δt) and the current azimuth equivalent signal Hz (t). Therefore, this equivalent Z gyro signal Gz 'is expressed by the following equation.

【0056】[0056]

【数23】 [Equation 23]

【0057】ここで、Δtは、演算の時間間隔である。
この等価Z加速度信号Az′が数23により得られたこ
とで、3軸のジャイロ信号を用いるCTM演算部20の
演算動作が可能になる。Z加速度演算部40において、
入力されたX加速度信号AXとY加速度信号AYとを用
いて、等価Z加速度信号Az′を演算して水平演算部2
1に出力する。まず、センサブロック部1′の取付軸1
0の座標系が、静止している場合、作用する加速度は重
力加速度だけであるから、図3を参照すると次式とな
る。
Here, Δt is a calculation time interval.
Since the equivalent Z acceleration signal Az ′ is obtained by the equation 23, the arithmetic operation of the CTM arithmetic unit 20 using the triaxial gyro signals becomes possible. In the Z acceleration calculation unit 40,
Using the input X acceleration signal AX and Y acceleration signal AY, the equivalent Z acceleration signal Az 'is calculated to calculate the horizontal calculation unit 2
Output to 1. First, the mounting shaft 1 of the sensor block 1 '
When the coordinate system of 0 is stationary, the acceleration that acts is only the gravitational acceleration, so referring to FIG.

【0058】[0058]

【数24】 [Equation 24]

【0059】ここで、gは重力加速度である。よって、
数22より、等価Z加速度信号Az′は、次式のとおり
得られる。
Here, g is the acceleration of gravity. Therefore,
From Eq. 22, the equivalent Z acceleration signal Az 'is obtained by the following equation.

【0060】[0060]

【数25】 [Equation 25]

【0061】又は、近似すれば、Or, if approximated,

【0062】[0062]

【数26】 [Equation 26]

【0063】 このジャイロバイアス演算部50とジャイロバイアス修
正部51の動作を具体的に説明する。まず、図1に示さ
れる姿勢検出装置の誤差修正モデルは、次式のとおりで
ある。
[0063] The operations of the gyro bias calculation unit 50 and the gyro bias correction unit 51 will be specifically described. First, the error correction model of the attitude detection device shown in FIG. 1 is as follows.

【0064】[0064]

【数27】 [Equation 27]

【0065】 [0065]

【0066】[0066]

【数28】 [Equation 28]

【0067】 [0067]

【0068】[0068]

【数29】 [Equation 29]

【0069】 [0069]

【0070】[0070]

【数30】 [Equation 30]

【0071】 [0071]

【0072】[0072]

【数31】 [Equation 31]

【0073】 [0073]

【0074】[0074]

【数32】 [Equation 32]

【0075】である。 It is

【0076】[0076]

【数33】 [Expression 33]

【0077】のとき、数24の右辺には、X、Yジャイ
ロバイアス信号BX、BY の影響がなくなる。
At this time, the influence of the X, Y gyro bias signals B X , B Y disappears on the right side of the equation 24.

【0078】 [0078]

【0079】ジャイロバイアス演算部50とジャイロバ
イアス修正部51の動作を述べると以下となる。
The operations of the gyro bias calculation unit 50 and the gyro bias correction unit 51 will be described below.

【0080】[0080]

【数34】 [Equation 34]

【0081】また、センサブロック部1′での取付軸1
0の座標系が、比較的大きな加速度運動している場合、
作用する加速度は、重力加速度と運動加速度とになる。
従って、検出したX、Y加速度信号AX、AYを用い
て、Z加速度演算部40での数25又は数26の演算よ
り求められた等価Z加速度信号Az′は、正しいZ軸の
重力加速度の値にならない。そこで、取付軸10のX、
Y軸にそれぞれX速度計、Y速度計を設け、このX、Y
速度計からのX、Y軸のそれぞれの速度信号VX、VY
を用いて、次式の演算を行うことで、運動加速度の影響
を受けない等価Z加速度信号Az′が得られる。すなわ
ち、Z加速度演算部40において、数25を修正して、
Also, the mounting shaft 1 in the sensor block 1 '
When the coordinate system of 0 is moving with relatively large acceleration,
The acting acceleration is gravitational acceleration and motion acceleration.
Therefore, the equivalent Z acceleration signal Az ′ obtained by the calculation of the equation 25 or the equation 26 in the Z acceleration calculator 40 using the detected X and Y acceleration signals AX and AY is the correct value of the gravitational acceleration of the Z axis. do not become. Therefore, X of the mounting shaft 10,
An X speed meter and a Y speed meter are provided on the Y axis.
Speed signals VX and VY for the X and Y axes from the speedometer
The equivalent Z acceleration signal Az ′ that is not affected by the motion acceleration is obtained by performing the calculation of the following equation using That is, in the Z acceleration calculation unit 40, the equation 25 is modified to

【0082】[0082]

【数35】 [Equation 35]

【0083】とし、また数26を修正して、Then, by modifying equation 26,

【0084】[0084]

【数36】 [Equation 36]

【0085】とする。以上のことにより、取付軸10
に、X、Yジャイロ11G、12G、X、Y加速度計1
1A、12A及び磁気方位検出器13Y′により、従来
と同じ姿勢検出装置が構成できる。尚本発明は上述実施
例に限ることなく本発明の要旨を逸脱することなく、そ
の他種々の構成が採り得ることは勿論である。
It is assumed that Due to the above, the mounting shaft 10
X, Y gyro 11G, 12G, X, Y accelerometer 1
The 1A and 12A and the magnetic azimuth detector 13Y 'can constitute the same attitude detecting device as the conventional one. Note that the present invention is not limited to the above-described embodiments, and needless to say, various other configurations can be adopted without departing from the gist of the present invention.

【0086】[0086]

【発明の効果】本発明によれば、2個のジャイロ、2個
の加速度計そして方位センサの構成で従来の姿勢検出装
置と同様の精度を実現でき、それだけ構成か簡単となる
利益があると共に従来の姿勢検出装置では、その価格に
おいて3個のジャイロ、3個の加速度計そして方位セン
サの各価格の合計が大部分をしめていたので、本発明に
よる1個のジャイロと1個の加速度計の低減は、直接価
格の低減に連がる利益がある。
According to the present invention, the same accuracy as that of the conventional attitude detecting device can be realized with the structure of two gyros, two accelerometers and the direction sensor, and there is an advantage that the structure is simple. In the conventional attitude detection device, the total price of the three gyros, the three accelerometers, and the azimuth sensor occupies most of the price, so that one gyro and one accelerometer according to the present invention are used. The reduction has the benefit of directly reducing the price.

【0087】また、本発明によれば1個のジャイロと1
個の加速度計の低減により、機構部の構成が簡単になる
ので、電子回路の低減等が期待でき、また部品数の低減
により柔軟な取付配置の構成が可能となり、重量の低減
化もまた容易となる利益がある。
Further, according to the present invention, one gyro and one gyro
The reduction in the number of individual accelerometers simplifies the structure of the mechanical section, which can be expected to reduce the number of electronic circuits, and the reduction in the number of parts enables flexible mounting arrangements, which also facilitates weight reduction. There is a profit to be.

【0088】更にまた本発明によれば使用するジャイロ
バイアス成分を推定し、除去する機能を有するので、振
動ジャイロ、ガスレートジャイロ等の比較的小型で安価
なジャイロの使用が可能となるために、さらに低価格な
姿勢検出装置を提供できる利益があると共に本発明によ
れば使用する磁気方位検出器が、重力加速度方向の垂直
軸まわりの方位角を検出するタイプでも、取付軸10の
Z軸まわりの方位角を検出するタイプでも、わずかな修
正を行うことで対応できる利益があり、更に本発明の姿
勢検出装置が比較的大きな加速度運動をする場合、取付
軸10のX、Y軸に取付けたX、Y速度計のX、Y速度
を用いることで、容易に、加速度の影響を受けない姿勢
角発信を行うことができる利益がある。
Furthermore, according to the present invention, since it has a function of estimating and removing the gyro bias component to be used, it is possible to use a relatively small and inexpensive gyro such as a vibration gyro and a gas rate gyro. Even if the magnetic azimuth detector used in accordance with the present invention detects the azimuth angle around the vertical axis in the direction of gravitational acceleration, the Z-axis of the mounting axis 10 can be provided. Even in the type that detects the azimuth angle, there is an advantage that it can be dealt with by making a slight correction. Further, when the posture detection device of the present invention makes a relatively large acceleration motion, it is mounted on the X and Y axes of the mounting shaft 10. By using the X and Y velocities of the X and Y velocimeters, it is possible to easily perform posture angle transmission that is not affected by acceleration.

【図面の簡単な説明】[Brief description of drawings]

【図1】本発明ストラップダウン方式の姿勢検出装置の
一実施例を示す構成図である。
FIG. 1 is a configuration diagram showing an embodiment of a strap-down type posture detection device of the present invention.

【図2】本発明の演算部2′の例を示す構成図である。FIG. 2 is a configuration diagram showing an example of a calculation unit 2'of the present invention.

【図3】本発明の説明に供する線図である。FIG. 3 is a diagram for explaining the present invention.

【図4】図3のジャイロバイアス演算部50とジャイロ
バイアス修正部51との説明に供する線図である。
FIG. 4 is a diagram for explaining a gyro bias calculation unit 50 and a gyro bias correction unit 51 of FIG.

【図5】従来の姿勢検出装置の例を示す構成図である。FIG. 5 is a configuration diagram showing an example of a conventional attitude detection device.

【図6】従来の演算部2の例を示す構成図である。FIG. 6 is a configuration diagram showing an example of a conventional calculation unit 2.

【符号の説明】[Explanation of symbols]

1′ センサブロック部 2′ 演算部 11A X加速度計 11G Xジャイロ 12A Y加速度計 12G Yジャイロ 13Y′ 磁気方位検出器 20 CTM演算部 21 水平演算部 22 起立演算部 23 方位演算部 30 座標修正部 31 Zジャイロ演算部 40 Z加速度演算部 50 ジャイロバイアス演算部 51 ジャイロバイアス修正部 1'Sensor block section 2'Calculation section 11A X accelerometer 11G X gyro 12A Y accelerometer 12G Y gyro 13Y 'Magnetic direction detector 20 CTM calculation section 21 Horizontal calculation section 22 Standing calculation section 23 Direction calculation section 30 Coordinate correction section 31 Z gyro calculation unit 40 Z acceleration calculation unit 50 Gyro bias calculation unit 51 Gyro bias correction unit

フロントページの続き (72)発明者 中村 慎一 東京都大田区南蒲田2丁目16番46号 株式 会社トキメツク内Front Page Continuation (72) Inventor Shinichi Nakamura 2-16-46 Minami-Kamata, Ota-ku, Tokyo Within Tokimetsu Co., Ltd.

Claims (2)

【特許請求の範囲】[Claims] 【請求項1】 右手直交3軸座標O−XYZと一致する
取付軸において、そのX軸には、X軸方向の加速度を検
出するX加速度計とX軸まわりの角速度を検出するXジ
ャイロとが取付られ、そのY軸には、Y軸方向の加速度
を検出するY加速度計とY軸まわりの角速度を検出する
Yジャイロとが取付られ、そのZ軸には、Z軸まわりの
方位角を検出する磁気方位検出器が取付けられたセンサ
ブロック部と、 該センサブロック部の上記X及びY加速度計から出力さ
れるX及びY加速度信号、上記X及びYジャイロから出
力されるX及びYジャイロ信号、そして上記磁気方位検
出器から出力される方位信号を入力とし、姿勢角、ロー
ル角信号、ピッチ角信号そして方位角信号を演算して、
発信する演算部とより構成されることを特徴とするスト
ラップダウン方式の姿勢検出装置。
1. An X-accelerometer for detecting acceleration in the X-axis direction and an X-gyro for detecting angular velocity around the X-axis are attached to the X-axis of the mounting axis that coincides with the right-handed orthogonal triaxial coordinate O-XYZ. A Y accelerometer that detects acceleration in the Y axis direction and a Y gyro that detects angular velocity around the Y axis are attached to the Y axis, and an azimuth angle around the Z axis is detected on the Z axis. A sensor block unit to which a magnetic azimuth detector is attached, X and Y acceleration signals output from the X and Y accelerometers of the sensor block unit, X and Y gyro signals output from the X and Y gyros, Then, using the azimuth signal output from the magnetic azimuth detector as an input, the attitude angle, roll angle signal, pitch angle signal and azimuth angle signal are calculated,
A strapdown-type posture detection device, characterized in that it is configured with a calculation unit for transmitting.
【請求項2】 請求項1記載のストラップダウン方式の
姿勢検出装置において、上記演算部に、重力加速度方向
の垂直軸まわりの方位角を演算する機能、上記取付軸の
Z軸まわりの角速度を演算する機能、上記Z軸方向の加
速度を演算する機能、上記X及びYジャイロ信号に含ま
れるX及びYジャイロバイアス成分を推定演算する機能
及び、上記X及びYジャイロバイアス成分を除去する機
能を設け、上記X及びY加速度計、上記X及びYジャイ
ロのおのおの2個ずつを用いたストラップダウン方式の
演算ができるようにしたことを特徴とするストラップダ
ウン方式の姿勢検出装置。
2. The strapdown-type posture detection device according to claim 1, wherein the computing unit has a function of computing an azimuth angle about a vertical axis in the direction of gravity acceleration, and an angular velocity of the mounting shaft about the Z axis. A function for calculating the acceleration in the Z-axis direction, a function for estimating and calculating the X and Y gyro bias components included in the X and Y gyro signals, and a function for removing the X and Y gyro bias components. A strapdown-type attitude detection device, wherein a strapdown-type calculation using two of each of the X and Y accelerometers and two of the X and Y gyros is possible.
JP3247603A 1991-09-26 1991-09-26 Strap down type attitude detection device Expired - Fee Related JP3038452B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP3247603A JP3038452B2 (en) 1991-09-26 1991-09-26 Strap down type attitude detection device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP3247603A JP3038452B2 (en) 1991-09-26 1991-09-26 Strap down type attitude detection device

Publications (2)

Publication Number Publication Date
JPH0587585A true JPH0587585A (en) 1993-04-06
JP3038452B2 JP3038452B2 (en) 2000-05-08

Family

ID=17165968

Family Applications (1)

Application Number Title Priority Date Filing Date
JP3247603A Expired - Fee Related JP3038452B2 (en) 1991-09-26 1991-09-26 Strap down type attitude detection device

Country Status (1)

Country Link
JP (1) JP3038452B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011227017A (en) * 2010-04-23 2011-11-10 Univ Of Tokyo Device and method for attitude estimation of moving body using inertial sensor, magnetic sensor, and speed meter

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3837533B2 (en) 2003-01-15 2006-10-25 独立行政法人産業技術総合研究所 Attitude angle processing apparatus and attitude angle processing method
JP4615287B2 (en) 2004-11-01 2011-01-19 東京計器株式会社 Azimuth and orientation detection device
WO2010001970A1 (en) 2008-07-02 2010-01-07 独立行政法人産業技術総合研究所 Moving body posture angle processing device

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011227017A (en) * 2010-04-23 2011-11-10 Univ Of Tokyo Device and method for attitude estimation of moving body using inertial sensor, magnetic sensor, and speed meter

Also Published As

Publication number Publication date
JP3038452B2 (en) 2000-05-08

Similar Documents

Publication Publication Date Title
JP5569681B2 (en) POSITION ESTIMATION DEVICE AND POSITION ESTIMATION METHOD OF MOBILE BODY USING INDUCTION SENSOR, MAGNETIC SENSOR AND SPEED METER
JP4615287B2 (en) Azimuth and orientation detection device
JPH09106322A (en) Posture angle detector in head-mounted display
US3924824A (en) Cross track strapdown inertial quidance system
JP3763435B2 (en) Attitude angle detector
JP3960574B2 (en) Attitude angle detector
JP3038452B2 (en) Strap down type attitude detection device
JP4023889B2 (en) Attitude angle detector
RU2107897C1 (en) Method of inertia navigation
JP2913122B2 (en) Strap down gyro device
JP3992206B2 (en) Attitude angle detector
JP3425689B2 (en) Inertial device
JPS62106385A (en) Method of calculating roll angle and pitch angle of vehicle and doppler inertial loop therefor
JP3960575B2 (en) Attitude angle detector
US6085149A (en) Integrated inertial/VMS navigation solution
JPH06201863A (en) Strapped-down attitude detection apparatus
JP3360089B2 (en) Inertial device
JP2000356520A (en) Attitude angle detector
Huddle Advances in strapdown systems for geodetic applications
JP2004132769A (en) Attitude angle detector
CN119687967B (en) A method for retrospective correction and alignment of a swaying base of a launch system
JP2001033253A (en) Attitude angle detector
JP2756554B2 (en) Inertial device
JP3357903B2 (en) Inertial device
JPH06109477A (en) Strapdown attitude detector

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees