JP4382551B2 - Swivel angle measuring device and crane equipped with the same - Google Patents
Swivel angle measuring device and crane equipped with the same Download PDFInfo
- Publication number
- JP4382551B2 JP4382551B2 JP2004091420A JP2004091420A JP4382551B2 JP 4382551 B2 JP4382551 B2 JP 4382551B2 JP 2004091420 A JP2004091420 A JP 2004091420A JP 2004091420 A JP2004091420 A JP 2004091420A JP 4382551 B2 JP4382551 B2 JP 4382551B2
- Authority
- JP
- Japan
- Prior art keywords
- boom
- crane
- turning angle
- measuring device
- gyroscope
- 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
Links
- 230000001133 acceleration Effects 0.000 claims description 16
- 239000000835 fiber Substances 0.000 description 11
- 230000003287 optical effect Effects 0.000 description 11
- 238000010586 diagram Methods 0.000 description 10
- 238000000034 method Methods 0.000 description 7
- 238000001514 detection method Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
Images
Landscapes
- Gyroscopes (AREA)
- Jib Cranes (AREA)
Description
この発明は移送装置のブーム(可動アーム)の旋回角を測定する旋回角測定装置及びそれを備えているクレーンに関し、特にクレーンのブームの旋回角を測定するのに適した旋回角測定装置及びそれを備えているクレーンに関する。 The present invention relates to a swivel angle measuring device for measuring a swivel angle of a boom (movable arm) of a transfer device, and a crane equipped with the swivel angle measuring device. Relates to a crane equipped with
従来、ファイバオプティカルジャイロを用いた旋回角度計測器が知られている(下記特許文献1参照)。この旋回角度計測器はクレーンのブームの旋回角度を計測する装置である。
Conventionally, a turning angle measuring device using a fiber optical gyro is known (see
この旋回角度計測器は制御用コンピュータ、ブームの起伏角度測定器、無線モデム及び警告灯とともにクレーンの制御部を構成する。 This turning angle measuring device constitutes a crane control unit together with a control computer, a boom hoisting angle measuring device, a wireless modem and a warning light.
この制御部はパソコン及びタブレットからなるデータ入力部とともにクレーンの制御装置を構成する。 This control unit constitutes a crane control device together with a data input unit composed of a personal computer and a tablet.
この制御装置のデータ入力部はクレーンのオペレータが乗り込むクレーン操作室に置かれている。制御装置の制御部はクレーン本体の近傍に置かれる。その制御部の一構成要素である旋回角度計測器はブームに取り付けられる。
上述のように従来の旋回角度計測器のファイバオプティカルジャイロはブームに取り付けられるので、仮にこのファイバオプティカルジャイロが1軸であるとすると、ブームの起伏角が変化するのに伴ってファイバオプティカルジャイロの入力軸が傾き、ブームの旋回角度を正確に測定できなくなる。 As described above, since the fiber optical gyro of the conventional turning angle measuring instrument is attached to the boom, if this fiber optical gyro is uniaxial, the input of the fiber optical gyro is changed as the undulation angle of the boom changes. The axis is tilted and the boom turning angle cannot be measured accurately.
ブームの旋回角度を正確に測定する方法としては、もう一つファイバオプティカルジャイロをブームに取り付け、このファイバオプティカルジャイロによってブームの起伏角度を測定し、この起伏角度に基づいて旋回角度を補正する方法が考えられる。 Another method of accurately measuring the swing angle of the boom is to attach a fiber optical gyro to the boom, measure the undulation angle of the boom with this fiber optical gyro, and correct the swing angle based on this undulation angle. Conceivable.
しかし、この方法ではファイバオプティカルジャイロを2つ用いるので、コストが高くなる。 However, since this method uses two fiber optical gyros, the cost increases.
高いコストをかけずに旋回角度を正確に測定する方法として、ファイバオプティカルジャイロをクレーン本体に取り付ける方法が考えられる。しかし、この方法では、ブームに重いものが吊り下げられたとき、クレーン本体が傾き、これに伴ってファイバオプティカルジャイロの入力軸が傾き、やはり正確な旋回角度を測定できなくなる。 As a method for accurately measuring the turning angle without incurring a high cost, a method of attaching a fiber optical gyro to the crane body can be considered. However, according to this method, when a heavy object is suspended from the boom, the crane body tilts, and the input shaft of the fiber optical gyroscope tilts accordingly, so that an accurate turning angle cannot be measured.
この発明はこのような事情に鑑みてなされたもので、その課題は高いコストをかけずにブームの旋回角を正確に測定することができる旋回角測定装置を提供することである。 The present invention has been made in view of such circumstances, and an object thereof is to provide a turning angle measuring device that can accurately measure the turning angle of a boom without high cost.
前述の課題を解決するため請求項1の発明の旋回角測定装置は、ブームの旋回角を測定する旋回角測定装置において、入力軸が前記ブームの旋回軸に平行になるように設けられ、前記ブームの角速度を計測する1軸のジャイロスコープと、前記ブームの遠心加速度と重力加速度との合成加速度を計測する加速度計と、前記1軸のジャイロスコープの出力と前記加速度計の出力とに基づいて前記ブームの旋回角を演算する演算手段とを備えていることを特徴とする。
In order to solve the above-mentioned problem, the turning angle measuring device of the invention of
上述のように、ジャイロスコープの出力と加速度計の出力とに基づいてブームの旋回角を求めるようにしたので、ジャイロスコープの入力軸の傾きによる旋回角の誤差が解消される。 As described above, since the turning angle of the boom is obtained based on the output of the gyroscope and the output of the accelerometer, the error of the turning angle due to the inclination of the input shaft of the gyroscope is eliminated.
請求項2の発明のクレーンは請求項1記載の旋回角測定装置を備えていることを特徴とする。 A crane according to a second aspect of the present invention includes the turning angle measuring device according to the first aspect.
上述のように、ジャイロスコープの出力と加速度計の出力とに基づいてクレーンのブームの旋回角を求めるようにしたので、ジャイロスコープの入力軸の傾きによる旋回角の誤差が解消される。 As described above, since the turning angle of the boom of the crane is obtained based on the output of the gyroscope and the output of the accelerometer, the error of the turning angle due to the inclination of the input shaft of the gyroscope is eliminated.
以上説明したように請求項1の発明によれば、高いコストをかけずに正確にブームの旋回角を測定することができる。 As described above, according to the first aspect of the invention, the turning angle of the boom can be accurately measured without high cost.
請求項2の発明によれば、高いコストをかけずに正確にクレーンのブームの旋回角を測定することができる。 According to the invention of claim 2, the turning angle of the boom of the crane can be accurately measured without high cost.
以下、この発明の実施の形態を図面に基づいて説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
図1はこの発明の一実施形態に係る旋回角測定装置を備えたクレーンのクレーン本体が傾斜していない状態を示す概念図、図2は図1に示すクレーン本体が傾斜している状態を示す概念図、図3は図1に示す旋回角測定装置のブロック図、図4は図2に示す状態のときのジャイロスコープ及び加速度計の入力軸の傾きを示す概念図である。 FIG. 1 is a conceptual diagram showing a state in which a crane main body of a crane equipped with a turning angle measuring device according to an embodiment of the present invention is not inclined, and FIG. 2 shows a state in which the crane main body shown in FIG. 1 is inclined. 3 is a conceptual diagram, FIG. 3 is a block diagram of the turning angle measuring apparatus shown in FIG. 1, and FIG. 4 is a conceptual diagram showing the inclination of the input shaft of the gyroscope and accelerometer in the state shown in FIG.
図1に示すように、このクレーン21はクレーン本体22とブーム23と支柱24と旋回角測定装置1とを備える。
As shown in FIG. 1, the
クレーン本体22は操作室221と駆動源(図示せず)とを有する。クレーン本体22は、支柱24の中心軸と一致する旋回軸241を中心軸として旋回可能なように、支柱24の上端に取り付けられている。駆動源はクレーン本体22及びブーム23を駆動する。
The
ブーム23は、水平な軸(図示せず)を回転軸として回転(ブーム23の上昇・下降)できるように、クレーン本体22に取り付けられている。
The
支柱24は敷地などに設置される。
The
図3に示すように、旋回角測定装置1はジャイロスコープ3と加速度計5と演算器(演算手段)7とを有する。
As shown in FIG. 3, the turning
ジャイロスコープ3として例えば、1軸の入力軸31を有するファイバオプティカルジャイロスコープが用いられている。ジャイロスコープ3は入力軸31を旋回軸としてジャイロスコープ3が旋回したときの角速度を検出する。
As the gyroscope 3, for example, a fiber optical gyroscope having a
加速度計5は1軸の入力軸51を有する。加速度計5として例えばサーボ型加速度計が用いられる。加速度計5は入力軸51と平行な方向の加速度を検出する。
The
ジャイロスコープ3と加速度計5とは一体的にユニット化されている。このユニット9は操作室221に配置されている。クレーン本体22が傾いていない状態(図1に示す状態)のとき、ジャイロスコープ3の入力軸31は旋回軸241に平行である。また、加速度計5の入力軸51は、ジャイロスコープ3の入力軸31に直交し、クレーン本体22の前後方向D1(図1参照)に平行である。更に、加速度計5の中心点52は旋回軸241から所定距離rだけ離れている(図4参照)。
The gyroscope 3 and the
ジャイロスコープ3が検出する角速度はブーム23が旋回軸241を中心軸として旋回したときの角速度に等しい。また、クレーン本体22が傾いていないとき、加速度計5が検出する加速度は旋回軸241からrだけ離れた位置におけるブーム23の遠心加速度に等しい。
The angular velocity detected by the gyroscope 3 is equal to the angular velocity when the
演算器7はジャイロスコープ3の検出信号である角速度Ωz(t)と加速度計5の検出信号である加速度αとに基づいてブーム23の旋回角を演算する。演算器7は演算結果である旋回角βを表わす信号が出力され、その信号がクレーン本体22の旋回を制御するコントローラ11に入力される。演算器7、コントローラ11としてコンピュータが採用されている。
The
次に、ブーム23の旋回角をどのようにして検出するかについて説明する。
Next, how to detect the turning angle of the
図1に示すように、クレーン21のブーム23に軽い物体41を吊り下げた場合、クレーン本体22の底面22aは水平を保ち、旋回軸241とジャイロスコープ3の入力軸31とが平行である。この実施形態では、後述するようにクレーン本体22が傾いていないときも、ジャイロスコープ3の出力信号である角速度Ωz(t)と加速度計5の出力信号である加速度αとに基づいてブーム23の旋回角を演算する。
As shown in FIG. 1, when a
図2に示すように、クレーン21のブーム23に重い物体42を吊り下げた場合、クレーン本体22の底面22aは水平面に対して角度θだけ傾く。この結果、図4に示すように、ジャイロスコープ3の入力軸31は角度θと同じ角度だけ傾く。この場合、ジャイロスコープ3が検出する旋回角とブーム23の実際の旋回角βとの間に誤差が生じる。
As shown in FIG. 2, when a
この場合にジャイロスコープ3が検出する角速度Ωz(t)(時間関数とする)は、
但し、Ω(t)はブーム23の旋回角速度、θはクレーン本体22の底面22aと水平面Hとがなす角度である(図2参照)。
However, (omega) (t) is the turning angular velocity of the
逆にブーム23の旋回角速度Ω(t)は(1)式より、
また、加速度計5が検出する加速度αは、ブーム23が旋回することにより発生する旋回軸241からrだけ離れた位置における遠心加速度r(Ωz(t))2とクレーン本体22の傾きとによって発生する重力加速度gsinθ との合成となるため、
但し、rは旋回軸241から加速度計5の中心点52までの距離を表わし、gは重力加速度を表わす。
However, r represents the distance from the
次に(3)式よりθを導き出すと、
(2)式に(4)式を代入すると、
よって、ブーム23の旋回角βは、
このように、rは旋回軸241から加速度計5の中心点52までの距離であるので、旋回角度測定装置1を操作室221に設置した後、演算器7のメモリ(図示せず)にrを定数として記憶させておく。
Thus, since r is the distance from the turning
以上のように、ブーム23の旋回角βを演算するときにθに応じて旋回角βが補正される。
As described above, when the turning angle β of the
この実施形態によれば、クレーン21のブーム23に重い物体が吊り下げられてクレーン本体22が傾いたとしてもブーム23の旋回角を正確に測定することができる。
According to this embodiment, even if a heavy object is suspended from the
また、構成が簡素であるので、ジャイロスコープを2つ用いる方法に較べコストを抑えることができる。 In addition, since the configuration is simple, the cost can be reduced as compared with the method using two gyroscopes.
次に、建設現場でのクレーンの動きについて説明する。 Next, the movement of the crane at the construction site will be described.
図5は図1に示す旋回角測定装置を備えた2つのクレーンを上方から見た状態を示す概念図である。 FIG. 5 is a conceptual diagram showing a state where two cranes equipped with the turning angle measuring device shown in FIG. 1 are viewed from above.
図5に示すように、第1クレーン21と第2クレーン21´とはブーム同士が衝突しないだけの間隔で設置されておらず、第1クレーン21と第2クレーン21´との間には衝突範囲Aが存在する。この衝突範囲A内では、第1クレーン21のブーム23と第2クレーン21´のブーム23´とが衝突する可能性がある。
As shown in FIG. 5, the
この実施形態では、いずれか一方のブーム23又は23´が衝突範囲Aにあるとき、他方のブーム23´又は23の回転可能な範囲を強制的に制限する衝突回避システムが採用されている。すなわち、図5に示すように、第2クレーン21´のブーム23´が衝突範囲Aにあるとき、第1クレーン21のブーム23は衝突範囲Aを除いた範囲でしか回転できない。
In this embodiment, when either one of the
この衝突回避システムに上記旋回角測定装置1を用いると、一方又は両方のブーム23,23´に重い物体42が吊り下げられたとしても、軽い物体41が吊り下げられたときと同様に、ブーム23,23´の正しい旋回角を測定することができるので、ブーム23,23´同士の衝突を確実に回避することができる。
When the turning
なお、上述の旋回角測定装置1はクレーン21に適用されたが、クレーン21に代えて例えば、産業用ロボットの可動アーム(ブーム)等にも適用することができる。
In addition, although the above-mentioned turning
また、この実施形態の旋回角測定装置1では、ジャイロスコープとしてファイバオプティカルジャイロスコープを用いているが、ジャイロスコープとしてはこれに限られず、レーザ式や機械式のジャイロスコープ等を用いてもよい。
Further, in the turning
なお、この実施形態では、加速度計5の入力軸51はジャイロスコープ3の入力軸31に直交し、クレーン本体22の前後方向D1に平行になるように設置されているが、加速度計5の入力軸51は必ずしもこのように配置されなくともよい。例えば、加速度計5の入力軸51とジャイロスコープ3の入力軸31とがなす角度及び加速度計5の入力軸51とクレーン本体22の前後方向D1とがなす角度が分かっていれば、ブーム23の旋回角βを演算する過程でこれらの角度をキャンセルすることができる。
In this embodiment, the
1 旋回角測定装置
3 ジャイロスコープ
31 入力軸
5 加速度計
51 入力軸
7 演算器(演算手段)
21 クレーン
22 クレーン本体
23 ブーム
24 支柱
241 旋回軸
DESCRIPTION OF
21
Claims (2)
入力軸が前記ブームの旋回軸に平行になるように設けられ、前記ブームの角速度を計測する1軸のジャイロスコープと、
前記ブームの遠心加速度と重力加速度との合成加速度を計測する加速度計と、
前記1軸のジャイロスコープの出力と前記加速度計の出力とに基づいて前記ブームの旋回角を演算する演算手段と
を備えていることを特徴とする旋回角測定装置。 In the turning angle measuring device for measuring the turning angle of the boom,
A single-axis gyroscope provided so that an input shaft is parallel to the pivot axis of the boom and measuring the angular velocity of the boom;
An accelerometer for measuring a combined acceleration of the centrifugal acceleration of the boom and the gravitational acceleration;
A turning angle measuring device comprising: a calculating means for calculating a turning angle of the boom based on an output of the one-axis gyroscope and an output of the accelerometer.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004091420A JP4382551B2 (en) | 2004-03-26 | 2004-03-26 | Swivel angle measuring device and crane equipped with the same |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004091420A JP4382551B2 (en) | 2004-03-26 | 2004-03-26 | Swivel angle measuring device and crane equipped with the same |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2005272126A JP2005272126A (en) | 2005-10-06 |
JP4382551B2 true JP4382551B2 (en) | 2009-12-16 |
Family
ID=35172187
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004091420A Expired - Lifetime JP4382551B2 (en) | 2004-03-26 | 2004-03-26 | Swivel angle measuring device and crane equipped with the same |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4382551B2 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109813343B (en) * | 2019-03-21 | 2021-06-08 | 哈尔滨工业大学 | Method for measuring initial alignment error of centrifugal machine |
-
2004
- 2004-03-26 JP JP2004091420A patent/JP4382551B2/en not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JP2005272126A (en) | 2005-10-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5642409B2 (en) | Crane control device and crane | |
WO2013057758A1 (en) | Rotation type working machine and control method for rotation type working machine | |
KR20120018118A (en) | Mobile working machine comprising a position control device of a working arm and method for controlling the position of a working arm of a mobile working machine | |
JP2019503443A (en) | Control of drilling tool head direction | |
JPH10168810A (en) | Road vertically sectional profile measuring device | |
JP3143204B2 (en) | Hole bending measuring device and hole bending measuring method | |
JP2007263689A (en) | Azimuth measuring method for apparatus in environment where external information can not be acquired | |
US11230019B2 (en) | Posture angle calculation apparatus, moving apparatus, posture angle calculation method, and program | |
JP2008002842A (en) | Method and device for measuring attitude of working machine | |
KR101776819B1 (en) | Turnover Prediction Method of Excavator | |
JP4382551B2 (en) | Swivel angle measuring device and crane equipped with the same | |
TW201024684A (en) | System and method for measuring tilt using lowest degrees of freedom of accelerometer | |
JP3852592B2 (en) | Gyro apparatus and method of using gyro apparatus for excavation | |
JP2008281508A (en) | Measuring device of angle of gradient | |
JP2014041117A (en) | Method for measuring position of underground excavation, device for measuring position of underground excavation, and excavation system for non-open-cut method | |
CN107923752B (en) | Navigation equipment and operating method with the turntable for overturning measurement | |
TWI392848B (en) | Method for identifying the orientation and navigation apparatus using the same | |
JPS61126413A (en) | Tilt angle sensor of moving type crane | |
JP2005147696A (en) | Attaching angle calculation system | |
JP6836118B2 (en) | Accelerometer adjustment system | |
JP2003139536A (en) | Declinometer and azimuth measuring method | |
JP4442064B2 (en) | Navigation device and navigation method | |
JP4318582B2 (en) | Inclination angle measuring apparatus and inclination angle measuring method | |
KR102490250B1 (en) | Hybrid tilt measuring apparatus | |
JP2012141219A (en) | Inclination angle detection device, method, program, and storage medium |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060928 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20090826 |
|
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: 20090917 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090917 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121002 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |