JPH08143273A - クレーンの振れ角検出方法およびクレーン用振れ角センサ - Google Patents

クレーンの振れ角検出方法およびクレーン用振れ角センサ

Info

Publication number
JPH08143273A
JPH08143273A JP31406994A JP31406994A JPH08143273A JP H08143273 A JPH08143273 A JP H08143273A JP 31406994 A JP31406994 A JP 31406994A JP 31406994 A JP31406994 A JP 31406994A JP H08143273 A JPH08143273 A JP H08143273A
Authority
JP
Japan
Prior art keywords
crane
deflection angle
rate gyro
hook portion
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
Application number
JP31406994A
Other languages
English (en)
Inventor
Hiroshi Sekine
宏 関根
Osamu Yamaguchi
収 山口
Koichi Abe
康一 阿部
Hiromi Makita
弘美 牧田
Kimio Shiozawa
公男 塩沢
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.)
JFE Engineering Corp
Tamagawa Seiki Co Ltd
Kokan Densetsu Kogyo KK
Original Assignee
Tamagawa Seiki Co Ltd
Kokan Densetsu Kogyo KK
NKK Corp
Nippon Kokan Ltd
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 Tamagawa Seiki Co Ltd, Kokan Densetsu Kogyo KK, NKK Corp, Nippon Kokan Ltd filed Critical Tamagawa Seiki Co Ltd
Priority to JP31406994A priority Critical patent/JPH08143273A/ja
Publication of JPH08143273A publication Critical patent/JPH08143273A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Length Measuring Devices With Unspecified Measuring Means (AREA)
  • Gyroscopes (AREA)
  • Control And Safety Of Cranes (AREA)

Abstract

(57)【要約】 【目的】 クレーンの振れ角検出方法およびクレーン用
振れ角センサに関し、特に、レートジャイロからの角速
度信号を用いて振れ角を検出する。 【構成】 フック部5に少なくとも2軸のレートジャイ
ロ10を設け、このレートジャイロ10から得た角速度
信号10aを用いて座標変換を行ない、フック部5の振
れ角θを検出する。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】この発明は、クレーンの振れ角検
出方法およびクレーン用振れ角センサに関し、特に、レ
ートジャイロ(光ファイバージャイロ等)からの角速度
信号および加速度計からの加速度信号を用いて振れ角を
検出するための新規な改良に関するものである。
【0002】
【従来の技術】従来、用いられていたこの種のクレーン
の振れ角検出方法としては、一般に、第1の方法として
フック部に2軸の傾斜計を取付け、フック部の振れを検
出していた。また、他の第2の方法としては、横行およ
び走行の移動速度および加速度を制御して振れ止めを行
っていた。また、他の第3の方法としては、フック部の
荷振れをメカ式のバーチカルジャイロで検出し、横行お
よび走行の駆動を行うモータの加・減速制御によって振
れ止めを行っていた。
【0003】
【発明が解決しようとする課題】従来の検出方法は、以
上のように構成されていたため、次のような課題が存在
していた。即ち、第1の方法の場合、クレーンの加減速
時には、フック部の振れ角のみではなく、クレーン加減
速をも検出してしまい、フック部の振れ角の正確な計測
が困難であった。また、フック部を吊り下げているワイ
ヤに捩りが発生した場合、傾斜計はフック部に取り付け
られているため、走行方向または横行方向基準でもっ
て、フック部がどの程度振れているかを検出することが
困難となっていた。
【0004】また、第2の方法の場合、横行および走行
の加・減速制御だけでは、荷の大きさおよびアーム系の
長さに応じて変動する外乱モーメント(風等)が誤差と
なっていた。
【0005】また、第3の方法の場合、荷の振れ角を検
知できるので、改善はなされているが、荷が回転すると
座標基準を失って、横行および走行のモータ制御に誤差
が生じていた。
【0006】この発明は、以上のような課題を解決する
ためになされたもので、特に、レートジャイロからの角
速度信号および加速度計からの加速度信号を用いて、振
れ角を検出すると共に、座標基準を失うことのないよう
にしたクレーンの振れ角検出方法およびクレーン用振れ
角センサを提供することを目的とする。
【0007】
【課題を解決するための手段】請求項1記載のこの発明
のクレーンの振れ角検出方法は、クレーン(1)に吊下
げられたフック部(5)に少なくとも2軸のレートジャ
イロ(10)を設け、前記レートジャイロ(10)から
得られた角速度信号(10a)を用いて座標変換を行な
い、前記クレーン(1)の建屋の座標系と比較すること
により、前記フック部(5)の振れ角(θ)を検出する
ことに特徴を有するものである。
【0008】請求項2記載の発明は、請求項1記載のク
レーンの振れ角検出方法において、前記レートジャイロ
(10)は3軸とし、前記3軸に設けられた加速度計
(11)を有し、前記各レートジャイロ(10)のオフ
セット分を前記各加速度計(11)からの加速度信号
(11a)に基づいて除去することに特徴を有するもの
である。
【0009】請求項3記載のこの発明のクレーン用振れ
角センサは、クレーン(1)に吊下げられたフック部
(5)に設けられた少なくとも2軸のセンサを用いて、
前記フック部(5)の振れ角(θ)を検出するようにし
たクレーン用振れ角センサにおいて、前記センサとして
レートジャイロ(10)を用いたことに特徴を有するも
のである。
【0010】請求項4記載の発明は、請求項3記載のク
レーン用振れ角センサにおいて、前記レートジャイロ
(10)を3軸構成とし、前記フック部(5)に設けら
れた3軸構成の加速度計(11)を有することに特徴を
有するものである。
【0011】
【作用】本発明によるクレーンの振れ角検出方法および
クレーン用振れ角センサにおいては、クレーンに吊り下
げられたフック部に少なくとも2軸のレートジャイロを
設け、この各レートジャイロから得られた各速度信号を
用いて座標変換を行ない、クレーンの建屋の座標系と比
較することによりフック部の振れ角を検出することがで
きる。また、2軸を3軸構成とし、3軸の加速度センサ
を用いた場合には、振れ角の検出精度を向上させること
ができる。
【0012】
【実施例】以下、図面と共に本発明によるクレーンの振
れ角検出方法およびクレーン用振れ角センサの好適な実
施例について詳細に説明する。
【0013】図1において、符号1で示されるものは建
屋(図示せず)の中に収容され、走行軸Xと横行軸Yを
有し、走行モータ2と横行モータ3とを有するクレーン
であり、この横行モータ3にワイヤ4を介して吊下げら
れたフック部5には、クレーン用振れ角センサ6が設け
られている。このフック部5のフック片5aには荷7が
係止して吊り下げられている。
【0014】前記クレーン用振れ角センサ6は、図2で
示されるように、2軸または3軸のレートジャイロ(光
ファイバージャイロ、ガスレートセンサ等)10および
2軸または3軸の加速度計11(但し、この加速度計1
1は用いない場合もある)よりなり、前述のレートジャ
イロ10からの角速度信号10aはクオータニオンアッ
プ・デート12に変換されて方向余弦マトリックス13
に変換され、且つ、この方向余弦マトリックス13は加
速度座標変換部14および演算部15に入力されてい
る。
【0015】前記演算部15は、座標変換15a、トル
キング計算15b、および、地球モラール計算15cの
3つの機能を主として有し、この方向余弦マトリックス
13を基にこの演算部15により座標変換15aを介し
て振れ角θおよび角速度ωが出力されるように構成され
ている。
【0016】次に、動作について述べる。まず、図1に
おける走行軸X、横行軸Yおよび鉛直軸Zを基準座標
(X,Y,Z)とし、この基準座標(X,Y,Z)は、
前記クレーン1の建屋の座標と同一である。ここで、横
行軸Yから吊下げられたフック部5に直交3軸座標(x
b ,yb ,zb )を設定する。この各座標軸に一致する
ようにレートジャイロ10および加速度計11を取り付
ける。
【0017】前記クレーン1の横行および走行が始まる
と、図3で示すように、フック部5が加速度等を受けて
振れるが、この値を振れ角θとしている。本発明では、
この振れ角θをX軸およびY軸成分θX 、θY に分け、
且つ、その角速度θX ドット、θY ドットを検出するこ
とができる。また、前述のθX 、θY 、θX ドット、θ
Y ドットは、フック部5が図3で示すzb 軸に回転して
も影響を受けないように前記演算部15で演算処理され
る。
【0018】次に、前述の演算部15の演算手順を図2
と共に説明する。まず、加速度計11の単位時間毎の積
分値(ΔVx ,ΔVy ,ΔVz )およびレートジャイロ
10の単位時間毎の積分値(Δθxb,Δθyb,Δθzb
を用い、フック部5の座標(xb ,yb ,zb )と前記
基準座標(X,Y,Z)間の方向余弦マトリックス13
を求める。この方向余弦マトリックス13を用いて振れ
角θの振れ角成分θx 、θY を次の数式〔数1〕により
求める。
【0019】
【数1】
【0020】上記(5)式は、図1中のクオータニオン
アップ・デートである。また、演算部15からのトルキ
ング15aは、方向余弦マトリックス13のBマトリッ
クスによって定められる。また、前述の加速度計11と
しては、フォースバランス型、半導体型および傾斜計を
用いることができる。
【0021】
【発明の効果】本発明によるクレーンの振れ角検出方法
およびクレーン用振れ角センサは、以上のように構成さ
れているため、次のような効果を得ることができる。 振れ角センサとして、レートジャイロを用い角速度
信号を用いて座標変換を行っているため、加減速の影響
を受けることなく高精度の振れ角を検出することがで
き、安定したフック部の位置制御を行うことができる。 また、センサ部は検出範囲および分解能等を用途に
応じて自在に選ぶことができる。 また、演算制御であるため、自在な制御を行うこと
ができる。 また、ガスレート、光ファイバージャイロを用いた
場合には、異常時の検出が容易であると共に、耐環境性
にも優れた特性を得ることができる。
【図面の簡単な説明】
【図1】この発明の実施例に係るクレーンの構成を示す
斜視図である。
【図2】この発明の実施例に係るブロック図である。
【図3】この発明の実施例に係る座標を示す斜視図であ
る。
【符号の説明】
1:クレーン 2:走行モータ 3:横行モータ 4:ワイヤ 5:フック部 5a:フック片 6:クレーン用振れ角センサ 7:荷 10:レートジャイロ 10a:角速度信号 11:加速度計 12:クオータニオンアップ・デート 13:方向余弦マトリックス 14:加速度座標変換部 15:演算部 15a:座標変換、トルキング 15b:トルキング計算 15c:地球モラール計算 θ:振れ角
───────────────────────────────────────────────────── フロントページの続き (72)発明者 山口 収 東京都千代田区丸の内一丁目1番2号 日 本鋼管株式会社内 (72)発明者 阿部 康一 神奈川県横浜市鶴見区小野町1 鋼管電設 工業株式会社内 (72)発明者 牧田 弘美 神奈川県横浜市鶴見区小野町1 鋼管電設 工業株式会社内 (72)発明者 塩沢 公男 長野県飯田市大休1879 多摩川精機株式会 社内

Claims (4)

    【特許請求の範囲】
  1. 【請求項1】 クレーン(1)に吊下げられたフック部
    (5)に少なくとも2軸のレートジャイロ(10)を設
    け、前記レートジャイロ(10)から得られた角速度信
    号(10a)を用いて座標変換を行ない、前記クレーン
    (1)の建屋の座標系と比較することにより、前記フッ
    ク部(5)の振れ角(θ)を検出することを特徴とする
    クレーンの振れ角検出方法。
  2. 【請求項2】 前記レートジャイロ(10)は3軸と
    し、前記3軸に設けられた加速度計(11)を有し、前
    記各レートジャイロ(10)のオフセット分を前記各加
    速度計(11)からの加速度信号(11a)に基づいて
    除去することを特徴とする請求項1記載のクレーンの振
    れ角検出方法。
  3. 【請求項3】 クレーン(1)に吊下げられたフック部
    (5)に設けられた少なくとも2軸のセンサを用いて、
    前記フック部(5)の振れ角(θ)を検出するようにし
    たクレーン用振れ角センサにおいて、前記センサとして
    レートジャイロ(10)を用いたことを特徴とするクレ
    ーン用振れ角センサ。
  4. 【請求項4】 前記レートジャイロ(10)を3軸構成
    とし、前記フック部(5)に設けられた3軸構成の加速
    度計(11)を有することを特徴とする請求項3記載の
    クレーン用振れ角センサ。
JP31406994A 1994-11-22 1994-11-22 クレーンの振れ角検出方法およびクレーン用振れ角センサ Pending JPH08143273A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP31406994A JPH08143273A (ja) 1994-11-22 1994-11-22 クレーンの振れ角検出方法およびクレーン用振れ角センサ

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP31406994A JPH08143273A (ja) 1994-11-22 1994-11-22 クレーンの振れ角検出方法およびクレーン用振れ角センサ

Publications (1)

Publication Number Publication Date
JPH08143273A true JPH08143273A (ja) 1996-06-04

Family

ID=18048859

Family Applications (1)

Application Number Title Priority Date Filing Date
JP31406994A Pending JPH08143273A (ja) 1994-11-22 1994-11-22 クレーンの振れ角検出方法およびクレーン用振れ角センサ

Country Status (1)

Country Link
JP (1) JPH08143273A (ja)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7648036B2 (en) * 2003-11-14 2010-01-19 Siemens Aktiengesellschaft Systems and methods for sway control
JP2015147629A (ja) * 2014-02-05 2015-08-20 Ihi運搬機械株式会社 クレーン吊荷の振れ角検出装置
JP2016222363A (ja) * 2015-05-27 2016-12-28 多摩川精機株式会社 姿勢検出装置及び姿勢検出方法
CN108217460A (zh) * 2018-01-12 2018-06-29 湖南科技大学 一种起重机负载空间摆角实时检测系统及方法
WO2020001991A1 (de) * 2018-06-26 2020-01-02 Liebherr-Components Biberach Gmbh Kran und verfahren zum steuern eines solchen krans
CN113865539A (zh) * 2021-10-11 2021-12-31 李志伟 一种用于机构偏角及转动副间隙免拆测量的测量方法

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7648036B2 (en) * 2003-11-14 2010-01-19 Siemens Aktiengesellschaft Systems and methods for sway control
JP2015147629A (ja) * 2014-02-05 2015-08-20 Ihi運搬機械株式会社 クレーン吊荷の振れ角検出装置
JP2016222363A (ja) * 2015-05-27 2016-12-28 多摩川精機株式会社 姿勢検出装置及び姿勢検出方法
CN108217460A (zh) * 2018-01-12 2018-06-29 湖南科技大学 一种起重机负载空间摆角实时检测系统及方法
WO2020001991A1 (de) * 2018-06-26 2020-01-02 Liebherr-Components Biberach Gmbh Kran und verfahren zum steuern eines solchen krans
CN112585079A (zh) * 2018-06-26 2021-03-30 利勃海尔比伯拉赫零部件有限公司 起重机及其控制方法
CN112585079B (zh) * 2018-06-26 2023-08-04 利勃海尔工厂比伯拉赫股份有限公司 起重机及其控制方法
US11987476B2 (en) 2018-06-26 2024-05-21 Liebherr-Werk Biberach Gmbh Crane and method for controlling such a crane
EP4501839A3 (de) * 2018-06-26 2025-04-30 Liebherr-Werk Biberach GmbH Kran und verfahren zum steuern eines solchen krans
CN113865539A (zh) * 2021-10-11 2021-12-31 李志伟 一种用于机构偏角及转动副间隙免拆测量的测量方法
CN113865539B (zh) * 2021-10-11 2024-03-19 李志伟 一种用于机构偏角及转动副间隙免拆测量的测量方法

Similar Documents

Publication Publication Date Title
CN103213134B (zh) 机械手的控制方法和机械手
CN102459766B (zh) 具有工作臂的位置控制装置的移动工作机械和用于控制移动工作机械的工作臂的位置的方法
JPS6241189A (ja) クレ−ン制御方式
KR960000247B1 (ko) 서스펜션 제어장치
JPH08143273A (ja) クレーンの振れ角検出方法およびクレーン用振れ角センサ
JP3033363B2 (ja) 自走台車の絶対位置検出方法
JPH01267462A (ja) 車両スリップ角測定装置
JP5907037B2 (ja) 移動体
JPH079374A (ja) 多関節ロボットの制御方法及び多関節ロボット
JP4517258B2 (ja) 水中航走体とその方位・姿勢角検出方法
JP3081146B2 (ja) クレーン吊り荷振れ角センサー校正方法
JP3062410B2 (ja) 光ファイバージャイロ付きクレーン用フック
JPH10139368A (ja) 吊荷の振れ止め及び位置決め制御装置
JP3277802B2 (ja) クレーン
JPH04237637A (ja) 車両の運動推定装置、その方法及び車両の制御システム
CN212584548U (zh) 一种长距离供水管道检测机器人
JP3261210B2 (ja) クレーンの振れ防止方法及び振れ防止機能付クレーン装置
JPH07294240A (ja) 位置センサ
JP2004132769A (ja) 姿勢角検出装置
JP4183316B2 (ja) 吊荷の振れ止め制御装置
JP3215753B2 (ja) クレーンの振れ止め制御方法
JPH0557526B2 (ja)
JP2766726B2 (ja) 振れ止め制御装置
JPH06201863A (ja) ストラップダウン方式の姿勢検出装置
JP3574519B2 (ja) 振れ止め制御用振れ角センサの0点補正方法