JP2004219079A - 傾斜角計測装置および傾斜角計測方法 - Google Patents
傾斜角計測装置および傾斜角計測方法 Download PDFInfo
- Publication number
- JP2004219079A JP2004219079A JP2003003039A JP2003003039A JP2004219079A JP 2004219079 A JP2004219079 A JP 2004219079A JP 2003003039 A JP2003003039 A JP 2003003039A JP 2003003039 A JP2003003039 A JP 2003003039A JP 2004219079 A JP2004219079 A JP 2004219079A
- Authority
- JP
- Japan
- Prior art keywords
- pendulum
- main body
- acceleration
- angle
- tilt angle
- 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
Links
Images
Abstract
【解決手段】重心から離れた位置の軸を介して本体に回転自在に取り付けられる振り子と、本体に作用する加速度を少なくとも2軸方向について検出する加速度検出器と、振り子と本体との相対角度を検出する検出手段と、加速度検出器で検出された加速度を振り子の運動方程式に適用して振り子の角度を求め、この振り子の角度から検出手段で検出された相対角度を引くことにより本体の傾斜角を算出する演算手段とを備える。
【選択図】 図1
Description
【発明の属する技術分野】
本発明は、動揺や振動を伴う構造物(例えば車両や船舶などの移動体)に搭載され、構造物の傾斜角を計測する傾斜角計測装置および傾斜角計測方法に関する。
【0002】
【従来の技術】
従来の傾斜角計測装置(傾斜計)には、振り子を使用するもの、液面の傾斜を利用するもの、加速度計を利用するものなどがある。これらは、基本的に重力の方向に対する傾きを計測するものである。例えば加速度計を利用したものでは、加速度計に作用する加速度をa、重力加速度をgとすると、傾斜角θは
θ=sin−1(a/g) …(1)
として求まる。
【0003】
しかし、このような従来装置では、外乱加速度が作用すると正確な傾斜角度が得られない問題がある。例えば、図5に示すように加速度計3に加速度bが作用すると、加速度計3で検出される加速度aは、
a=gsinθ+bcosθ …(2)
となる。この値を使って計算される傾斜角θ′は、前記の計算式により
θ′=sin−1(a/g)=sin−1(sinθ+bcosθ/g) …(3)
となり、真の傾斜角θに対して誤差をもつ。
【0004】
そこで、外乱加速度によって生じる誤差を回避する手段として、ファイバーオプティカルジャイロ等を用いた角速度検出手段(レートジャイロ)の出力を積分して角度を計算する方法が考えられている。しかし、レートジャイロは低周波のドリフトを有し、積分誤差が時間とともに増大する問題がある。
【0005】
この問題に対処する方法として、レートジャイロの出力をバンドパスフィルタを通して積分し、加速度計の出力をローパスフィルタを通してそれぞれを加算する方法が一般的に使われている。この方法により、レートジャイロの低周波ドリフトの影響と、中域の外乱加速度の影響を回避することができる。ただし、低周波域の情報を加速度計が受け持つために、例えばゆっくりと旋回する運動や、時間をかけて加速する運動など、低周波成分をもつ外乱加速度の影響は除去することができない。
【0006】
この低周波の外乱加速度に対処する方法として、特許文献1では1軸方向の加速度を検出する加速度計と、振り子の傾きから外乱の影響を補正する方法が提案されている。なお、特許文献2では、液面のダイナミクスを考慮した提案がなされているが、加速度外乱に関して考慮されておらず、構造物の動揺や振動下における傾斜角を計測することができない。
【0007】
【特許文献1】
特開平9−329437号公報
【特許文献2】
特許第2909358号公報
【0008】
【発明が解決しようとする課題】
特許文献1の方法では、加速度計の検出方向の直線加速度のみを補正でき、検出方向と直角成分をもつ加速度の影響を除去することができない。さらに、振り子の回転軸と加速度計の位置が離れている場合、回転による加速度外乱の影響も除去できない。さらに、特許文献1では、振り子の運動が考慮されていないので、外乱加速度が変化する場合に真の傾斜角を計算することができない。
【0009】
本発明は、動揺する構造物上に設置された傾斜角計測装置において、構造物の動揺や振動下においても傾斜角を正確に計測することができる傾斜角計測装置および傾斜角計測方法を提供することを目的とする。
【0010】
【課題を解決するための手段】
本発明は、本体に作用する加速度を加速度検出器で検出し、振り子と本体の相対角度(または相対角速度)を検出し、検出された加速度を振り子の運動方程式に適用して振り子の角度(または角速度)を算出し、この振り子の角度(または角速度)から相対角度(または相対角速度)を引く(または引いて積分する)ことにより、本体の傾斜角を算出する(請求項1,2,4,5)。あるいは、本体および振り子に作用する加速度を検出し、検出された加速度を振り子の運動方程式に適用して本体の傾斜角を算出する(請求項3,6)。
【0011】
以下、図3,4を参照して本体の傾斜角の算出過程について説明する。ここでは、本体に作用する加速度を、簡単のために振り子の軸に作用する加速度として検出する例を示すが、加速度検出器が振り子の軸から離れた位置に取り付けられる場合には、振り子の運動方程式に適用する際に、その位置を考慮して振り子の軸に作用する加速度に換算すればよい。
【0012】
図3において、振り子5の軸7に作用する加速度をa、振り子5の重心6に作用する加速度ベクトルをa0 、振り子5の重心まわりの角加速度ベクトルをα、振り子5の重心まわりの角速度ベクトルをω、振り子5の重心6から軸7までのベクトルをrとし、3次元的に表記すると、慣性座標系において、
a=a0 +α×r+ω×(ω×r) …(4)
の関係が成り立つ。ここで、×は外積を表す。
【0013】
振り子5の運動方程式は、図4において、振り子5の質量をm、振り子5の軸7に作用する力をF、振り子5の重心まわりの慣性モーメントをIとすると、
ma0 =F …(5)
Iα=r×F …(6)
となる。
【0014】
式(4) 〜(6) をまとめると、振り子5の運動方程式として
Iα=r×(ma0 )
=r×m(a−α×r−ω×(ω×r))
=r×m(a−α×r) …(7)
が得られる。
【0015】
一方、加速度検出器で検出される加速度の読みをxとすると、傾斜角に依存した座標変換行列Tを用いて
x=Ta …(8)
と表現される。したがって、振り子の運動方程式(7) は、
Iα=r×m(T−1x−α×r) …(9)
となり、この運動方程式(9) を解くことにより、振り子の角度(あるいは角速度)が得られる。
【0016】
次に、振り子と加速度検出器との相対角度が検出されるときは、振り子の角度から相対角度を引くことにより本体の傾斜角が得られる。また、振り子と加速度検出器との相対角速度が検出されるときは、振り子の角速度から相対角速度を引いて積分することにより、本体の傾斜角が得られる。
【0017】
ただし、式(9) を解く際に、αとrとTにそれぞれ傾斜角の要素が含まれるため、数学的に解くことは難しい。そこで、数値的に解いて傾斜角を得る。軸に摩擦や粘性がある場合は、軸の相対角速度と軸に作用する力に応じたトルクが発生する。この場合、実験的に摩擦係数や粘性係数を求め、運動方程式に反映させることで、本体の傾斜角を得ることができる。
【0018】
また、振り子に取り付けられた加速度検出器で振り子に作用する加速度を検出する場合には次のようになる。ここでは、振り子の重心に作用する加速度を検出するものとし、加速度検出器で検出される加速度の読みをx0 とすると、振り子の角度に依存した座標変換行列T0 を用いて
x0 =T0 a …(10)
と表現される。したがって、振り子の運動方程式(9) は、
Iα=r×mT0 −1x0 …(11)
となり、この運動方程式(11)を解くことにより、振り子の角度、角速度ω、角加速度αが得られる。
【0019】
よって、本体に取り付けられた加速度検出器で検出される加速度の読みxと併せて、
T−1x=T0 −1x0+α×r+ω×(ω×r) …(12)
の式から、座標変換行列Tに含まれる傾斜角を数値的に求めることができる。
【0020】
【発明の実施の形態】
図1は、本発明の傾斜角計測装置の構成例を示す。図において、傾斜角を計測する構造物に設置される傾斜角計測装置の本体1にロータリエンコーダ4が取り付けられ、ロータリエンコーダ4のロータの軸と振り子5の軸7が固定され、振り子5が本体1に対して回転自在となる。なお、ロータの軸に振り子5を固定してもよいし、振り子5の軸7にロータを固定してもよい。一方、ロータリエンコーダ4のハウジングに、z軸の加速度計2およびx軸の加速度計3が取り付けられる。ロータリエンコーダ4では、本体1と振り子5の相対角度が測定され、加速度計2,3では近似的に振り子5の軸7に加わる加速度が測定される。
【0021】
なお、本構成例は請求項1に対応し、振り子5と本体1の相対角度を検出する検出手段としてロータリエンコーダ4が用いられる。請求項2に対応して振り子5と本体1の相対角速度を検出する場合にはタコジェネレータのような角速度検出手段を用いればよい。また、請求項3に対応するには、本体1に取り付けられる加速度計2,3の他に、振り子5に加速度計2,3を追加すればよい。
【0022】
以下、図2を参照して本体1の傾斜角θの算出過程について説明する。図2において、初期状態でx軸方向に置かれた加速度計3が検出する加速度の読みをx、初期状態でz軸方向に置かれた加速度計2が検出する加速度の読みをz、振り子5の軸7に取り付けられたロータリエンコーダ4の読み(振り子5と本体1の相対角度)をδとし、振り子5の鉛直方向(z軸方向)からの角度をφとすると、本体1の傾斜角θは、
θ=φ−δ …(13)
で与えられる。なお、初期状態では、x=0、z=g(gは重力加速度)である。
【0023】
振り子5について、振り子5の軸7から振り子5の重心6までの距離をr、振り子5の質量をm、振り子5の重心まわりの慣性モーメントをIとすると、振り子5の運動方程式(9) より
(I+mr2)φ” =mr(−xcosδ+zsinδ) …(14)
の関係が得られる。ここで、φ” は振り子5の角加速度であり、
φ” =(φ−2φ−1+φ−2)/Δt2 …(15)
とする。φ−1とφ−2はそれぞれ1サンプル前と2サンプル前の振り子5の角度であり、Δtはサンプリング時間である。
【0024】
以上により、
(I+mr2)(φ+δ−2φ−1+φ−2)/Δt2 =mr(−xcosδ+zsinδ)…(16)
となる。この式をθに関して解くことにより、本体1の傾斜角θは、
θ=(Δt2/(I+mr2))mr(−xcosδ+zsinδ)−δ+2φ−1−φ−2…(17)
と得ることができる。
【0025】
【発明の効果】
以上説明したように、本発明は構造物に設置された傾斜角計測装置において、構造物が動揺や振動しても、それに影響されずに正確に構造物の傾斜角を計測することができる。
【図面の簡単な説明】
【図1】本発明の傾斜角計測装置の構成例を示す図。
【図2】本発明における傾斜角θの算出過程について説明する図。
【図3】本発明における傾斜角の測定原理を説明する図。
【図4】本発明における傾斜角の測定原理(力の釣り合い)を説明する図。
【図5】従来の傾斜角計測装置の測定原理を説明する図。
【符号の説明】
1 本体
2 加速度計(z軸)
3 加速度計(x軸)
4 ロータリエンコーダ
5 振り子
6 振り子の重心
7 軸
Claims (6)
- 重心から離れた位置の軸を介して本体に回転自在に取り付けられる振り子と、
前記本体に作用する加速度を少なくとも2軸方向について検出する加速度検出器と、
前記振り子と前記本体との相対角度を検出する検出手段と、
前記加速度検出器で検出された加速度を前記振り子の運動方程式に適用して振り子の角度を求め、この振り子の角度から前記検出手段で検出された相対角度を引くことにより前記本体の傾斜角を算出する演算手段と
を備えたことを特徴とする傾斜角計測装置。 - 重心から離れた位置の軸を介して本体に回転自在に取り付けられる振り子と、
前記本体に作用する加速度を少なくとも2軸方向について検出する加速度検出器と、
前記振り子と前記本体との相対角速度を検出する検出手段と、
前記加速度検出器で検出された加速度を前記振り子の運動方程式に適用して振り子の角速度を求め、この振り子の角速度から前記検出手段で検出された相対角速度を引いて積分することにより前記本体の傾斜角を算出する演算手段と
を備えたことを特徴とする傾斜角計測装置。 - 重心から離れた位置の軸を介して本体に回転自在に取り付けられる振り子と、
前記本体に作用する加速度を少なくとも2軸方向について検出する第1の加速度検出器と、
前記振り子に取り付けられ、振り子に作用する加速度を少なくとも2軸方向について検出する第2の加速度検出器と、
前記第1の加速度検出器および前記第2の加速度検出器で検出された各加速度を前記振り子の運動方程式に適用して前記本体の傾斜角を算出する演算手段と
を備えたことを特徴とする傾斜角計測装置。 - 本体に作用する加速度を少なくとも2軸方向について検出し、
重心から離れた位置の軸を介して前記本体に回転自在に取り付けられた振り子と前記本体との相対角度を検出し、
前記加速度を前記振り子の運動方程式に適用して振り子の角度を求め、この振り子の角度から前記相対角度を引くことにより前記本体の傾斜角を算出する
ことを特徴とする傾斜角計測方法。 - 本体に作用する加速度を少なくとも2軸方向について検出し、
重心から離れた位置の軸を介して前記本体に回転自在に取り付けられた振り子と前記本体との相対角速度を検出し、
前記加速度を前記振り子の運動方程式に適用して振り子の角速度を求め、この振り子の角速度から前記相対角速度を引いて積分することにより前記本体の傾斜角を算出する
ことを特徴とする傾斜角計測方法。 - 本体に作用する加速度を少なくとも2軸方向について検出し、
重心から離れた位置の軸を介して本体に回転自在に取り付けられた振り子に作用する加速度を少なくとも2軸方向について検出し、
前記本体および前記振り子に作用する各加速度を前記振り子の運動方程式に適用して前記本体の傾斜角を算出する
ことを特徴とする傾斜角計測方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003003039A JP3732829B2 (ja) | 2003-01-09 | 2003-01-09 | 傾斜角計測装置および傾斜角計測方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003003039A JP3732829B2 (ja) | 2003-01-09 | 2003-01-09 | 傾斜角計測装置および傾斜角計測方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004219079A true JP2004219079A (ja) | 2004-08-05 |
JP3732829B2 JP3732829B2 (ja) | 2006-01-11 |
Family
ID=32894418
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003003039A Expired - Fee Related JP3732829B2 (ja) | 2003-01-09 | 2003-01-09 | 傾斜角計測装置および傾斜角計測方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3732829B2 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009089047A (ja) * | 2007-09-28 | 2009-04-23 | Kyocera Corp | 携帯電子機器 |
WO2013023380A1 (zh) * | 2011-08-18 | 2013-02-21 | 长沙中联重工科技发展股份有限公司 | 一种倾角测量装置、方法及处理器 |
CN103837133A (zh) * | 2014-03-17 | 2014-06-04 | 徐工集团工程机械股份有限公司 | 作业车的曲臂倾斜角的测量方法及系统 |
EP2520793A3 (en) * | 2011-05-04 | 2014-10-08 | General Electric Company | Methods and apparatus for controlling wind turbine thrust |
-
2003
- 2003-01-09 JP JP2003003039A patent/JP3732829B2/ja not_active Expired - Fee Related
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009089047A (ja) * | 2007-09-28 | 2009-04-23 | Kyocera Corp | 携帯電子機器 |
EP2520793A3 (en) * | 2011-05-04 | 2014-10-08 | General Electric Company | Methods and apparatus for controlling wind turbine thrust |
WO2013023380A1 (zh) * | 2011-08-18 | 2013-02-21 | 长沙中联重工科技发展股份有限公司 | 一种倾角测量装置、方法及处理器 |
CN103837133A (zh) * | 2014-03-17 | 2014-06-04 | 徐工集团工程机械股份有限公司 | 作业车的曲臂倾斜角的测量方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
JP3732829B2 (ja) | 2006-01-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5028281B2 (ja) | センサバイアスキャンセルを用いた慣性計測システム及び方法 | |
EP1972892B1 (en) | Inertial measurement system and method with sensor bias cancellation | |
CN112567097B (zh) | 用于确定机器的作业设备的角度的方法 | |
EP2005199B1 (en) | Inertial measurement system and method with bias cancellation | |
US7257512B1 (en) | Methods and systems for vibropendulous error compensation of acceleration sensors | |
US9279682B2 (en) | Inertial unit having vibrating gyros mounted on a carousel, and an angle-measurement method | |
JPH04504169A (ja) | 北探知システム | |
JP2009529697A (ja) | 微小機械回転速度センサ | |
JP3732829B2 (ja) | 傾斜角計測装置および傾斜角計測方法 | |
US9217640B2 (en) | Gyroscopic measurement in a navigation system | |
JP2008281508A (ja) | 傾斜角度測定装置 | |
JP2926140B2 (ja) | 傾斜角度測定装置 | |
EP3798642B1 (en) | Coriolis vibratory accelerometer system | |
RU2003105730A (ru) | Способ стабилизации по крену инерциальной платформы для быстровращающихся объектов и стабилизированная по крену инерциальная платформа | |
JPS63275913A (ja) | 傾斜計 | |
JP2003139536A (ja) | 方位計および方位測定方法 | |
JP3783061B1 (ja) | 傾斜角と並進加速度の検出方法および検出装置 | |
JP4318582B2 (ja) | 傾斜角計測装置および傾斜角計測方法 | |
JP3208901B2 (ja) | 角速度センサの感度測定装置 | |
JP2006177909A (ja) | 慣性センサのバイアス測定方法及びその装置 | |
US20240110790A1 (en) | Method for correcting the measurement from a vibrating angular inertial sensor | |
JP2012141219A (ja) | 傾斜角検出装置、方法、プログラムおよび記録媒体 | |
JPH11337328A (ja) | 路面測定装置 | |
JPH11190633A (ja) | 方位計 | |
JPH09189548A (ja) | 列車用姿勢角センサ |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20050701 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050712 |
|
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: 20051004 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20051013 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091021 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101021 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101021 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111021 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111021 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121021 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121021 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131021 Year of fee payment: 8 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
LAPS | Cancellation because of no payment of annual fees |