レーザーポインタを用いた天井クレーンによる搬送方法及び天井クレーンシステム
【課題】レーザーポインタにより指示された３次元空間における目標搬送位置へ搬送物を搬送する方法及び天井クレーンを提供する。
【解決手段】コントローラを介して自動運転される天井クレーンを用いて搬送物を搬送開始位置から目標搬送位置の真上までの３次元空間における搬送径路に沿って自動的に搬送する方法であって：スポット光を撮像するための複数のカメラを設置し；レーザーポインタによりレーザー光線を目標搬送位置床表面に照射してスポット光を生成し；該生成されたスポット光を少なくとも１台のカメラで撮像し、該撮像データを利用してスポット光重心位置の３次元空間座標を決定し；前記３次元空間座標を前記目標搬送位置データとして利用して前記コントローラによって前記搬送径路を決定し、該搬送径路に沿って前記搬送物を前記搬送開始位置から前記目標搬送位置の真上まで自動的に搬送する；ことを含む自動搬送方法。
【解決手段】コントローラを介して自動運転される天井クレーンを用いて搬送物を搬送開始位置から目標搬送位置の真上までの３次元空間における搬送径路に沿って自動的に搬送する方法であって：スポット光を撮像するための複数のカメラを設置し；レーザーポインタによりレーザー光線を目標搬送位置床表面に照射してスポット光を生成し；該生成されたスポット光を少なくとも１台のカメラで撮像し、該撮像データを利用してスポット光重心位置の３次元空間座標を決定し；前記３次元空間座標を前記目標搬送位置データとして利用して前記コントローラによって前記搬送径路を決定し、該搬送径路に沿って前記搬送物を前記搬送開始位置から前記目標搬送位置の真上まで自動的に搬送する；ことを含む自動搬送方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、天井クレーンの吊り荷（搬送物）の搬送に関し、特に、吊り荷を搬送開始位置からレーザーポイントにより指示した目標搬送位置まで自動的に搬送する方法及びシステムに関する。
【背景技術】
【０００２】
天井クレーンは搬送対象が３次元空間上を自由に移動できることや、搬送物の大きさや重量の制限が少ないので、搬送車等の他の搬送装置に比べ各種工場や倉庫など幅広い産業分野に利用されている。しかし、天井クレーンはロープで荷物を吊るす構造のため、クレーンの操作法や搬送の軌道などによっては荷振れが生じやすい。荷振れが生じた場合は地上の荷物との衝突や荷崩れが発生する危険性がある。このため従来は熟練したオペレータが高度な操作技術により荷振れを生じさせないように操作を行ってきた。しかし、近年の労働環境では人件費の削減や作業効率の向上が求められ、熟練したオペレータの育成は困難となっている。そのためクレーンの自動化を目指す様々な研究が行われている。
【０００３】
その研究の分野として、障害物を回避するための経路計画、搬送物の荷振れ抑制のための振れ止め制御といった研究が挙げられる。
【０００４】
また、振れ止め制御の研究として、西村他による非特許文献１のように、ゲインスケジューリングによる振れ止め制御、橋本他による非特許文献２のように、台車の移動速度と位置の偏差をフィードバッグにより振れ止めを行う研究などが行われていた。
【０００５】
経路計画に関する研究では、本発明者の一人である寺嶋他による非特許文献３のように、最小エネルギ、最短距離となる搬送経路を分枝限定法によって導出している。この方法は搬送領域内の障害物を多角形で近似し、その頂点をサブゴールとする搬送パターンのうち、実現可能で評価関数を最小とする経路を効率的に探索するものである。
【０００６】
しかし、完全自動制御では、オペレータがクレーンを管理しているコンピュータの指令装置に行き、その場所で目標搬送位置を指令することでクレーンを制御するため、オペレータが指令装置のある場所に行く必要がある。そのため、リアルタイムに位置決めを行うことが困難である。
【０００７】
そこで、本発明では操縦者がレーザーポインタによってクレーンに指示を与えることを考える。レーザーポインタで目標搬送位置へスポット光を指すことにより、カメラがスポット光の位置を計測し、その位置を目標搬送位置としてクレーンが障害物回避と振れ止め制御を行いながら自動で搬送するシステムを構築する。このようなシステムであればレーザーポインタによって目標搬送位置を指示するだけでクレーンが自動で荷物を搬送するため、オペレータの作業量軽減や搬送時間、安全性向上などにも大きく貢献できると考えられる。
【０００８】
従来技術を示す以下の非特許文献は参照のために本明細書に組み入れられる。
【０００９】
非特許文献
非特許文献１：西村秀和、種村英朗、野波健蔵、走行クレーンのロープ長変動に対するゲインスケジュール位置決め制御、日本機械学会論文集（Ｃ編）、Ｖｏｌ。６２、Ｎｏ。５９９、ｐｐ．２６９２−２６９７、（１９９６）
非特許文献２：橋本幸雄、土谷武士、松田俊彦、杉岡一郎、荷振れ情報を必要としないクレーンの吊り荷の振動抑制制御、計測自動制御学会論文集、Ｖｏｌ。３０、Ｎｏ。２、ｐｐ。１７２−１８０、（１９９４）
非特許文献３：兼重明宏、寺嶋一彦、鈴木薪雄、殷雷、障害物認識と経路計画を考慮した天井クレーンの自律化、“日本機械学会論文集（Ｃ）”、Ｖｏｌ。６４、Ｎｏ。６１８、（１９９８）、ｐｐ．４８７−４９４
非特許文献４：井口征士、３次元画像計測、昭晃堂、（１９９０）
非特許文献５：G.K. Schmidt, K.Azarm, Mobile robot path planning and execution based on a diffusion equation
strategy”, Advanced Robotics 7-5(1993),pp.479-490
非特許文献６：斎藤武雄、“数値伝熱学”、養賢堂、（１９８６）
非特許文献７：杉原厚吉、“グラフィックスの数理”、共立出版、（１９９５）
非特許文献８：David F. Rogers、 J.Alan Adams、山口富士夫、“コンピュータグラフィックス”、日刊工業新聞社（１９７９）
非特許文献９：須永照雄、“機械工学における最適化手法”、機械の研究、４１−８、（１９８９）、ｐｐ．８６７−８７２
非特許文献１０：柳井法貴、山本元司、毛利彰、“逆動力学計算に基づくクレーンのフィードバック制御”、計測自動制御学会論文集、３７−１１、（２００１）、ｐｐ．１０４８−１０５５
非特許文献１１：Yanai N, Yamamoto M, Mohri A, “Anti-Sway Control for Wire-Suspended Mechanism Based on Dynamics Compensation”, Proc IEEE Int Conf Rob Autom, 4,(2002),pp.4287-4292
非特許文献１２：高橋伸寿，中沢洋介，梅田和昇，レーザーポインタを用いたホームロボット操作システムの構築，日本機械学会ロボティスク・メカトロニクス講演会講演論文集，pp2P1-K03(1)-2P1-K03(2),(2002)
非特許文献１３：PAROMTCHIK.I.E, ASAMA.H,“Mobile robot guidance by means of a laser pointer”, Proc ASTED IntConf Model Identif Control, Vol.2,pp.718-721,(2001)
【発明の開示】
【００１０】
本発明のアプローチは次のとおりである。天井クレーンの目標移動位置を決定するためのスポット光を認識するシステムの構築を行う。スポット光は、オペレータがレーザーポインタを搬送物の目標搬送位置まで持って行き、レーザーポインタから照射したレーザー光により目標搬送位置の床面を数秒間照射してスポット光を形成し、基本的には、２台のカメラ（例えば、ＣＣＤカメラ）により前記スポット光を撮像し、カメラに接続されたコントローラによりスポット光の位置決定を行うものである。なお、対象の床面を照射するようにレーザーポインタをクレーン（例えば、クレーン台車）にとりつけることもできる。
【００１１】
また、カメラとスポット光を結ぶ直線上に障害物等が存在するために１台のカメラだけでしかスポット光を計測できない場合もあることを想定して、１台のカメラで３次元位置を計測するアルゴリズムを提案する。障害物回避経路の計算には３次元拡散方程式に基づくポテンシャル法を適用する。ポテンシャル法はグラフ理論やＧＡ等による経路計画に比べ、複雑な障害物環境にも適用が容易で、計算時間が短い等の利点を有すため、クレーンの煩雑な障害物環境に有効であると考えられる。次に得られた経路を折れ線近似法により改善を行うことで、不要な折れ点が少ない経路を導出する。次に得られた経路を５次Ｂスプライン曲線で表す。曲線を表すパラメータを操作量とし、装置制約と障害物回避制約を満たし、搬送時間を最小にする最適化問題をコンプレックス法により解くことで台車の制御入力を導出する。制御入力を逆動力学計算によるフィードフォワード制御系に入力することで、荷物の軌道追従と振動抑制を行う。
【００１２】
また、障害物位置情報は、非特許文献３に記載される光切断法により全て既知であることを前提とする。
【発明の実施するための最良の形態】
【００１３】
図１に本発明の実施の形態の天井クレーンシステム１の概要図を示す。該システムの天井クレーンは台車２と、台車２を平面内で走行自在に支持するフレーム３と含む。走行方向（Ｘ軸）方向はガーダ４が移動し、横行方向（Ｙ軸）はガーダ上を搬送物１０を吊り下げた台車２が移動することによりＸ、Ｙ方向への独立した搬送が可能である。台車の移動は台車に設けたＡＣサーボモータ（図示省略）の駆動をタイミングベルト５Ａを介し、コントローラ６からモータへの電圧指令を与え、台車速度を制御する。また、搬送物１０はワイヤーロープ７により吊り下げられ、ＡＣサーボモータの駆動により台車下部の巻き取りドラム（図示省略）を回転させることにより、上下方向（Ｚ軸）に移動する。台車、ガーダ、ヤイヤーロープ、搬送物、サーボモータの関係は公知であり、詳細に説明はしない。
【００１４】
Ｘ、Ｙ、Ｚ方向の最大移動距離は、本実施の形態においては、２.０ｍ、１.０ｍ、１.２ｍ、搬送物１０は質量３０Ｋｇの鋼塊である。ロープ７の振れ角の測定にはレーザーセンサ（ＫＥＹＥＮＣＥ、ＶＧ−０３５）をロープの付け根の近くに取り付けて行う。
【００１５】
クレーンのフレームに２台の白黒ＣＣＤカメラ（ＳＯＮＹ、ＸＣ−ＨＲ５８）１１Ａ，１１Ｂを固定して、レーザーポインタのスポット光の撮像のために利用する。カメラのレンズの前には色ガラスフィルタ（ＨＯＹＡ、Ｒ−６０）を取り付けることでレーザー光以外の外乱交を遮断する。画像処理装置には画像処理ボード（Ｌｉｎｘ、銀河＋＋Ｍ２）を利用する。カメラは台車可動範囲にあるＸ、Ｙ軸方向の床面を全て撮像でき、Ｚ軸方向は最低０.３ｍ、最高１.０ｍの高さから撮像できる。レーザーポインタはスポット径が３ｍ先で約７ｍｍ〜４０ｍｍの直径に調整できるもの（ＶＥＲＯＳ、ＬＥＰＯ６５０）を使用する。
【００１６】
コントローラ６は種々の演算を実行するコンピュータを含み、カメラに接続されカメラが撮像した像を解析しスポット光の位置を決定できるように構成されている。また、以下に説明する各処理はコントローラ６によってなされる。
【００１７】
１．スポット光位置の計測法
１・１ スポット光位置の求め方
本発明では図１に示すように、スポット光認識のために２つのカメラ１１Ａ，１１Ｂをクレーンのフレーム３に固定する。障害物の設置位置によってはカメラの死角が存在するため、図２を使って想定される状況を述べる。
【００１８】
図２のＡ領域のように、大きい方の障害物の上面Ａ１とその側部の床面Ａ２は両方のカメラで撮像できる。図２のＢ領域とＣ領域はカメラ１１Ａのみが撮像できる。１つのカメラでのみ表面のスポット光を撮像できるときは、床面の座標をＺ＝０として２次元の（Ｘ、Ｙ）座標をコントローラ６で決定できるが、図２のＣ領域のスポット光により、３次元のクレーン座標（Ｘ、Ｙ、Ｚ）を決定することは不可能である。しかし、本発明では光切断法により全て把握されている障害物位置情報を用いることで１つのカメラの撮像により決定された（Ｕ、Ｖ）座標から３次元のクレーン座標（Ｘ、Ｙ、Ｚ）を決定することができる。
【００１９】
１・２ ２台のカメラの場合
カメラが２台ともスポット光を認識できる場合は本節で述べる方法によりスポット光のクレーン座標を求める。図２のカメラ１１ＡのカメラのパラメータをＣＡ１〜ＣＡ１１、カメラ座標を（ＵＡ、ＶＡ）、カメラ１１１ＢのカメラのパラメータをＣＢ１〜ＣＢ１１、カメラ座標を（ＵＢ、ＶＢ）、スポット光の座標を（Ｘ，Ｙ，Ｚ）とすると，非特許文献４に記載されるように、次式の関係が成り立つ。次式を行列で表したあと，一般逆行列を用いて最小二乗解を求めることで（Ｘ，Ｙ，Ｚ）を求める。
【式１】
【００２０】
１・３ １台のカメラの場合
障害物によってカメラの死角が生じる。このような場合はカメラ１台しかスポット光を認識できない場合もある。このときは（２）式によりスポット光の２次元クレーン座標を求める。（２）式はＺ＝０のときの（１）式を変形させた式である。（２）式はカメラ１１Ａのものであるが，カメラ１１Ｂのものも同様な式で求めることができる。
【式２】
【００２１】
１つのカメラで３次元位置を求めるアルゴリズム
図２のＣ領域（小さな方の障害物の上面）に吊り荷を搬送したい場合の例を図３に示す。Ｃ領域は、先に述べたように、Ａ１領域を有する大きい方の障害物にじゃまされてカメラ１１Ｂでは撮像できないが、カメラ１１Ａで撮像可能である。
【００２２】
図３に破線で示すように斜め上方からにレーザー光線をＣ領域に照射した場合を考える。スポット光がＣ領域に形成されるので、カメラ１１Ａにより該ポット光を撮像する。後に説明する方法（スポット光重心を求めるアルゴリズム）により、撮像したスポット光画像からスポット光の重心Ｂを画像的に決定し、コントローラ６を介してカメラ１１Ａの光軸をＢ点に合わせる。カメラ１１Ａの位置Ｃは既知であり、その座標は（Ｘ３，Ｚ３）である。Ｂ点の未知の座標を（Ｘ２，Ｚ２）とする。カメラ１１Ａの光軸と床面（２つの障害物が載っている面）との交点Ａの未知の座標を（Ｘ1，Ｚ1）とする。Ｂ（Ｘ２，Ｚ２）、すなわち、目標搬送位置を図３に関して、次に述べる方法で求める。
【００２３】
１）最初に、（２）式により座標Ａ（Ｘ１，Ｚ１）を求める。
【００２４】
２）既知である座標Ｃ（Ｘ３，Ｚ３）を利用して，障害物のＺ座標を探索するＺを，Ｚ＝Ｚ３として定義する。
【００２５】
３）Ｚ−１０［ｍｍ］を計算し，Ｘ方向を探索する係数Ｘを以下の（３）式により求める。
【式３】
【００２６】
４）３）を数回計算する。
【００２７】
５）障害物位置情報とＸ，Ｚを比較し，Ｘ＜Ｘ２，Ｚ＜Ｚ２が成立する直前のＸ，Ｚを取得して終了する。
【００２８】
上記アルゴリズムのステップ１）で床面上の点Ａの座標（Ｘ１，Ｚ１）は、座標Ｂ（Ｘ２，Ｚ２）とＡ（Ｘ１，Ｚ１）はカメラの画像面上では同じＵ，Ｖ座標にあるため，Ｚ＝０という仮定と（２）式を用いることで求まるものである。上記３）を数回計算することで，最初はＸ＝Ｘ３，Ｚ＝Ｚ３であったのが徐々にＸ，ＺはＸ２，Ｚ２に近づいていき，最終的にＸ＜Ｘ２，Ｚ＜Ｚ２が成立するように変化する。上記の計算により，障害物上の目標搬送位置の座標Ｂ（Ｘ２，Ｚ２）を求めることができる。
【００２９】
説明を簡便にするために、図３に示すＸ−Ｚ平面のみに関して説明したが、Ｙ−Ｚ平面に関しても同様であり、この計算法を使うことで障害物位置情報とスポット光の画像から３次元位置を求めることができる。この計算法を使うメリットとしては，カメラの画像面の座標と３次元座標との対応付けを行う必要がなくなるため，障害物の位置を変更するたびに３次元座標との対応付けを行う手間や，対応付けのためのプログラム変更の手間を省くことができる。
【００３０】
上記（３）式は空間上の２点間を結ぶ直線の方程式を変形させたものである。なお，この方法は光切断法により障害物位置情報が全て既知であるという前提のもとで行っている。
【００３１】
２．スポット光位置の計測実験
２・１ ２台のカメラによる計測校正済みカメラで静止した物体の座標を求めることで精度の確認を行う。ここで静止した物体の座標を求めているのは，レーザーポインタのスポット光ではｍｍ単位での位置決めは困難であり，計測誤差の確認には静止した物体の座標を求める方が容易であるためである。表１には実際に３次元座標を求めたときの例を示し，表の左に本来の３次元座標，右に計測結果を示す。単位はｍｍである。最大で１１ｍｍの誤差、最小で０ｍｍの誤差であった。
【表１】
【００３２】
２・２ １台のカメラによる計測
図４に示す障害物環境下で、校正済みカメラで静止した物体の座標を求めたときの計測結果を表２に示す。表の左に本来の３次元座標、右に計測結果を示す。単位はｍｍである。撮像に使ったカメラはカメラ１１Ａであるが、カメラ１１Ｂで撮像した場合も同様な結果になるため省略する。この結果より３次元座標を決定できた。最大で１４ｍｍの誤差、最小で０ｍｍの計測誤差であった。
【表２】
【００３３】
２・３ スポット光重心の導出
一般的にスポット光は大きさを持っている。レーザーポインタの当て方によっては大きな楕円となってしまい、楕円のどの位置を計測するかによって測定値が変わる問題が生じる。そこで本発明ではスポット光の重心位置を求めることでこの問題を解決する。スポット光の重心を求める方法としては、下に述べるアルゴリズムを用いる。
【００３４】
スポット光重心を求めるアルゴリズム：
１）カメラで撮像した画像から輝度値を取得し、輝度値２００以上の座標（図５の例では最も色の濃い領域）を取得する。
【００３５】
２）輝度値２００以上の座標（上記最も色の濃い領域）の中で、最も上下左右にある４つの座標（Ａ、Ｂ、Ｃ、Ｄ）を取得。
【００３６】
３） （Ａ＋Ｄ）／２と（Ｂ＋Ｃ）／２を計算してＥの座標を求める。この重心を求める方法は公知であり、一般に使用されている。
【００３７】
輝度値は０〜２５５段階に分かれる。コンクリートなどの画像は輝度値２００未満であるが、スポット光は輝度値２００以上となるので、撮像した画像から輝度値２００以上の画像を取得することでスポット光のみを取得できる。スポット光周辺（図５の例では色の薄い領域と周辺の背景）の輝度値は２００未満であるため、輝度値を取得する際に排除することができる。この処理によって撮像した画像はスポット光の画像（図５の例では色の濃い領域）のみが残るため、座標（Ａ、Ｂ、Ｃ、Ｄ）の位置を判別することが容易となる。
【００３８】
この方法でスポット光の位置を求める実験を行った。スポット光は十分な輝度を持ち、容易にカメラで認識ができた。
【００３９】
３．障害物回避経路の導出
３・１ ポテンシャル法
ポテンシャル法とは、非特許文献５に説明されるように、拡散方程式を用い、搬送領域内に仮想的な拡散物質を拡散させ、その濃度勾配（ポテンシャル場）を用いて経路を得るものである。３次元拡散方程式は次式となる。
【式４】
【００４０】
差分法により数値計算を行うため，（４）式を差分化すると、非特許文献６に示されるように、次式となる。
【式５】
【００４１】
さらに、境界条件として、以下の（６）式
【式６】
【００４２】
を恒久的に与え、それ以外のグリッドの初期条件として以下の（７）式
【式７】
【００４３】
を与える。荷物の大きさを無視するために，荷物を円柱と仮定し，荷物半径だけ障害物を拡大するものとした。荷物下端の位置を荷物経路のＺ座標とするため、障害物はＸ−Ｙ軸方向への拡大処理のみ行う。
【００４４】
図６（ａ）に示す３次元障害物環境に（５）〜（７）式を用いてポテンシャル場を生成した例を図６（ｂ）に示す。ここで、スタート地点Ｓを（０．１［ｍ］，０．１［ｍ］，０．３［ｍ］）、ゴール地点Ｇを（１．９［ｍ］，０．９［ｍ］，０．３［ｍ］）、搬送物半径を０．１５［ｍ］（グリッド幅Δｈ＝０．０５［ｍ］の場合の３グリッド相当）として障害物を拡大した。図６（ａ）の障害物周辺に拡大された障害物領域を示す。ただし，地面（Ｚ＝０［ｍ］）にのみ拡大障害物領域を示すものとする。図６より境界条件であるゴール地点で濃度Ｃ＝１，障害物領域内で濃度Ｃ＝０，障害物領域外ではゴール地点に近接するほど濃度は１に近く，離れるほど濃度は低下する。なお，実験の際には障害物の拡大処理を０．２［ｍ］（荷物半径０．１５［ｍ］＋安全余裕０．０５［ｍ］）とする。従って，スタート地点（図７に黒丸で示す基本グリッド(i,j,k)からその周囲２６グリッド（図中。印）の濃度を参照し，最大濃度となるグリッドを選択することで，障害物に衝突せずゴール地点にたどり着くことができる。このとき選択したグリッドを連結して得られる経路が障害物回避経路となる。図８に回避経路を導出した例を示す。実線が荷物の重心位置を示す回避経路である。
【００４５】
ここで，拡散方程式に基づくポテンシャル法の手順を以下にまとめる。
【００４６】
拡散方程式に基づくポテンシャル法：
１）対象となる３次元搬送領域（Ｘ，Ｙ，Ｚ）をグリッド幅Δｈのメッシュで区切り、障害物を該当するグリッドに配置する。
【００４７】
２）障害物を搬送物半径だけ拡大する。
【００４８】
３）（６）、（７）式により全グリッドの初期濃度Ｃo,ｉ,ｊ,ｋを与える。
【００４９】
４）（５）式を用いて境界条件を除く全グリッドの濃度Ｃｔ,ｉ,ｊ,ｋを更新する。
【００５０】
５）（８）式の終了条件を満足する場合には６）へ。満足しない場合には４）へ。
【００５１】
６）与えられたスタートグリッドＳを選択グリッドＰとする。
【００５２】
７）選択グリッドＰの周囲２６グリッドの中から最大濃度グリッドを選択し、選択グリッドＰをストックし更新する。
【００５３】
８）選択グリッドＰの濃度Ｃ＝１（ゴール地点Ｇ）であれば終了。それ以外は７）へ。
【００５４】
この手順においてストックされた選択グリッドＰが回避経路となる。なお、拡散終了条件には次式を用いる。
【式８】
【００５５】
ここで、Ｃｔ、Ｓは時刻ｔにおけるスタート地点Ｓの濃度である。（８）式はスタート地点における各計算ステップごとの濃度の変化比率を示している。この終了条件は定常するまでの拡散回数が障害物環境によって異なるため導入した。εＣｓは拡散プロセスの定常状態を判定する閾値であり、εＣｓ＝０．０１とし、拡散パラメータｒは０．０１とした。
【００５６】
３・２ 折れ線近似法
図８に示すように、ポテンシャル法によって得られた経路は折れ点の多い経路となる。台車軌道は折れ点の影響を受けやすく、不要な折れ点は搬送時間の増大を招く。そのため、最大濃度グリッドの点群を折れ線近似法により直線で近似する。この手法により不必要な折れ点を少なくする。近似の際には、経路が障害物領域に侵入しないことを条件に近似を行う。図９に障害物環境を用いた折れ線近似法の概要を示す。図中＿印で示されるスタート地点を線分の始点とする。線分の終点をゴール地点から経路データの点群（同図。印）を走査していき、障害物と衝突しない直線を探索する。図中の破線は障害物領域へ進入してしまうため選択されない。障害物と衝突しない直線を決定したならば、その直線の終点を新たに始点として直線を探索する。この操作を繰り返し行うと図１０に示すような近似結果が得られる。同図破線がポテンシャル法により得られた経路を表し、実線が直線近似を行った近似経路である。近似経路の折れ点数は１４点から４点に減少し、搬送距離が短縮されていることが分かる。以下に折れ線近似法の手順を示す。
【００５７】
折れ線近似法：
１）ポテンシャル法により得られた選択グリッドをＰｉ（ｉ＝１、・・・、ｎ）として、ｓ＝１、ｇ＝ｎとおく。
【００５８】
２）グリッドＰｓからグリッドＰｇまでの直線が障害物領域内を通過するか判定。またはＰｊ（ｊ＝ｓ、・・・、ｇ）の点群の障害物領域周辺からの位置が許容最大値ｅｍａｘ内であるかを判定。
【００５９】
３）上記直線が障害物領域を通過し、または上記点群が許容最大値を超える場合はｇ＝ｇ−１として２）へ。それ以外の場合、Ｐｇを折れ点としてストックし４）へ。
【００６０】
４）ｇ＝ｎなら終了、ｇがｎでないならｓ＝ｇ、ｇ＝ｎとして２）へ。
【００６１】
４．各種制約条件を考慮した荷物軌道の導出
４・１ ５次Ｂスプライン曲線
逆動力学計算を用いた制御系において、荷物軌道は４階微分が可能であることが求められるため、本発明では５次Ｂスプライン曲線を用いて荷物軌道を表現する。区間[ｉ,ｉ＋１]、（ｉ＝０、・・・、Ｎ−１）における５次Ｂスプライン曲線で表現された荷物軌道
【式９】
【００６２】
と時刻ｔ（ｓ）を次式で定義する。
【式１０】
【００６３】
本発明では折れ線近似法により得られた折れ点を用いることとする。ｓは０≦ｓ＜１とする曲線パラメータ，Ｎｊ（ｓ）は５次Ｂスプライン基底関数であり，deBoor-Coxの公式（非特許文献７及び８）により次式のように導出される。
【式１１】
【００６４】
従って，荷物軌道
【式１２】
【００６５】
は重みＮｊ（ｓ）を与えた周囲６点の制御点の線形結合により求められる。なお，（１０）式のスプライン基底関数Ｎｊ（ｓ）はｓの５次式で与えられることから，得られる荷物軌道
【式１３】
【００６６】
は４階微分可能となる。
【００６７】
４・２ 最適制御問題の定式化
制御点及び終端時刻を記述する制御点ベクトルを
【式１４】
【００６８】
と定義し，各種制約条件を考慮して評価関数を定式化し、最適解を導出する。制約条件に応じて与えるペナルティ項を付加した評価関数Ｊを次式で定義する。
【式１５】
【００６９】
ここで，ｌは制約条件の数，Ｗはペナルティ項の重み係数である。
【００７０】
（１４）式は制約条件下で高速な軌道を導出することを目的とした評価関数である。ペナルティ項の重みＷは１００００とする。Ｗは搬送時間ｔｆに対して十分に大きな値を与えることで，制約条件を満足する軌道が導出できる。また，ｈｉ（ｔ）はペナルティ関数であり，常に正値でなければならないので，制約条件ｇｉ（ｔ）に応じて次式で与える。
【式１６】
【００７１】
（１２）式では制約条件を満足しないときにのみペナルティ項が加算される。従って，制約条件を満足しない軌道は最適化過程で排除され，制約を満足し，かつ搬送時間の短い軌道が得られる。
【００７２】
４・３ モータの速度，加速度制約
次に各種制約条件について述べる。モータには有限の速度，加速度を有するので，モータの装置制約を考慮する必要がある。最適制御問題における制約条件をｇｉ（ｔ）≧０の形で表すと，台車速度
【式１７】
【００７３】
及び台車加速度
【式１８】
【００７４】
の制約は次式となる。
【式１９】
【００７５】
Ｙ軸についても同様である。Ｚ軸についてもモータの装置制約を考える。Ｚ軸のロープ巻き上げ下げ速度
【式２０】
【００７６】
及びロープ巻き上げ下げ加速度
【式２１】
【００７７】
の制約は次式となる。
【式２２】
【００７８】
制約条件として，台車速度
【式２３】
【００７９】
及び台車加速度
【式２４】
【００８０】
とした。また，残留振動抑制のためには搬送スタート地点及びゴール地点において荷物と台車は停止していなければならない。そのため，搬送スタート地点及びゴール地点では
【式２５】
【００８１】
の条件が与えられる。
【００８２】
４・４ ラプラス方程式を用いた進入抑制制約
荷物の障害物領域内への進入を抑制する制約としてラプラス方程式を用いた障害物回避のための制約条件を利用する。この制約条件を利用することで，求めた荷物軌道が障害物領域内に進入していないかを評価できる。次の手順で制約のための荷物軌道
【式２６】
【００８３】
により定まるポテンシャル場
【式２７】
【００８４】
を生成する。搬送領域内に２つのポテンシャル場Ｃｏ，Ｃｎを（１５）式のラプラス方程式により導出する。
【式２８】
【００８５】
ここで，初期条件としてＣｏ，Ｃｎ＝ｅｘｐ１，それぞれの境界条件として（１６）式
【式２９】
【００８６】
を用いる。
【００８７】
（１６）式の境界条件より，Ｃｏは障害物領域内でのみ値を有するポテンシャル場であり，Ｃｎは障害物領域内外でのみ値を有するポテンシャル場となる。得られた２つのポテンシャル場を用いてポテンシャル制約Ｃｒを求める。
【式３０】
【００８８】
ここでｌｏｇをとるのはＣｏ及びＣｎの指数的な変化を考慮するためである。図１１（ａ）に障害物環境、図１１（ｂ）にラプラス方程式により生成されたポテンシャル制約Ｃｒを示す。同図より生成されたポテンシャル場Ｃｒは必ず障害物領域内で正、領域外で負、境界で零となることが確認できる。また、搬送領域全域で勾配を有し、障害物が密集する領域ほどポテンシャル値Ｃｒは大きくなっている。ここで、Ｃｒが負であれば障害物領域に侵入しないことから、進入抑制のための制約条件は次式で与えられる。
【式３１】
【００８９】
４・５ コンプレックス法
（９）、（１０）式で、４階微分可能な荷物軌道
【式３２】
【００９０】
は表現できる。しかし、（１０）（１１）式において制御点
【式３３】
【００９１】
と搬送終端時刻ｔｆを決定する必要がある。従って、これらの変数を操作量とし、障害物回避等の各種制約条件を満足する最適制御問題を考える。そこで、制御点及び終端時刻を記述する制御点ベクトルを
【式３４】
【００９２】
と定義し、これを非線形最適化手法の一種であるコンプレックス法（非特許文献９）により最適化する。制御点の数を折れ線近似法により得られた折れ点の数Ｎとすれば、始端と終端の位置は固定されるため、
【式３５】
【００９３】
は３（Ｎ−２）＋１の最適化変数を有する。また、コンプレックス法における初期点の数Ｍは最適化変数の２倍程度にすることが好ましいとされているので、Ｍ＝６（Ｎ-２）＋１個の初期点を与えることとした（非特許文献９）。制御点ベクトル
【式３６】
【００９４】
をコンプレックス法により改善する手順を以下に示す。
【００９５】
コンプレックス法による最適化アルゴリズム：
１） 折れ点近似法により得られた制御点ベクトルを
【式３７】
【００９６】
とし、残りのＭ−１個の制御点ベクトル
【式３８】
【００９７】
の要素を次式により決定する。
【式３９】
【００９８】
ここで、ｉ＝１，・・・，Ｎ，２，・・・，Ｍ、Ｄｘ，Ｄｙ，Ｄｚ，Ｄｔｆは各制御点の探索域に対応して設定する値、ｒは区間[−０.５,０.５]の一様乱数である。
【００９９】
２） 各制御点ベクトルで定まる軌道に対して評価関数を計算し、評価値の最大値ＪＨを与える制御点ベクトル
【式４０】
【０１００】
と最小値ＪＬを与える制御点ベクトル
【式４１】
【０１０１】
を求める。
【０１０２】
３）εを収束の判定定数としてＪＨ−ＪＬ≦εの場合は終了、ＪＨ−ＪＬ＞εの場合は４）へ。
【０１０３】
４）最大点
【式４２】
【０１０４】
を除く制御点ベクトルの重心
【式４３】
【０１０５】
を求める。次式
【式４４】
【０１０６】
により最大点
【式４５】
【０１０７】
と重心
【式４６】
【０１０８】
とを結ぶ直線上で改良点
【式４７】
【０１０９】
を求め、その評価値ＪＣとおく。
【０１１０】
５）ＪＣ＜ＪＨならば
【式４８】
【０１１１】
を
【式４９】
【０１１２】
で置き換え、２）へ。ＪＣ≧ＪＨならばεαを十分小さな値として、α≧εαならαをα・βで置き換え４）へ、α＜εαならαを初期値に戻し、
【式５０】
【０１１３】
を
【式５１】
【０１１４】
に置き換え４）へ。
【０１１５】
ここで、図１０に示すように上記手法の軌道生成のシミュレーションを行う。条件として初期制御点数と初期値は障害物環境を用いた折れ線近似法により得られた折れ点を与えるものとする。αの初期値は１．３、βの初期値は０．５とする（非特許文献９）。また、探索域Ｄｘ＝Ｄｙ＝Ｄｚ＝０.１ｍ、Ｄｔｆ＝１ｓとし、ε＝０．０１、εα＝０．０１とした。このときの初期制御点及び改善後の制御点の位置を図１２に示す。図より改善後の制御点は搬送領域外に位置しているが、この制御点より得られるＢスプライン軌道はラプラスポテンシャル場による制約条件により搬送領域内でかつ障害物回避を行う。
【０１１６】
実際に軌道生成シミュレーション結果を行った結果を図１２の太実線に示す。折れ線であった経路（図中破線）が曲線で表され、さらに障害物を回避する形となっていることがわかる。
【０１１７】
５．制振制御と軌道追従のための制御系の構築
５・１ 逆動力学計算によるＦＦ制御
本発明では、荷物の軌道追従、振動抑制を非特許文献１０に記載される逆動力学計算によるフィードフォワード制御により行う。この手法は荷物軌道
【式５２】
【０１１８】
を実現する台車軌道
【式５３】
【０１１９】
を力の釣り合いから得られる以下の（２１）式
【式５４】
【０１２０】
によって導出する手法である。ここで，ｇは重力加速度である。さらに，この台車軌道をモータの逆モデルに入力することで，実際の天井クレーンの台車軌道及び荷物軌道が
【式５５】
【０１２１】
となるＦＦ制御入力
【式５６】
【０１２２】
を得る。ＦＦ制御入力導出の過程は図１３となる。ただし，（４３）式及びモータの逆モデルはそれぞれ入力の２階微分を含むことから，荷物軌道は４階微分可能なものしか実現することができない。そのため，本発明では５次Ｂスプライン曲線を導入することで４回微分可能な荷物軌道
【式５７】
【０１２３】
を得ている。
【０１２４】
次に，天井クレーンのモータを１次遅れ系と仮定すると，与えられた台車軌道
【式５８】
【０１２５】
を実現する制御入力
【式５９】
【０１２６】
は次式により求められる。
【式６０】
【０１２７】
ここで，
【式６１】
【０１２８】
は各軸のモータゲインを成分とする対角行列，
【式６２】
【０１２９】
は各軸のモータ時定数を成分とする対角行列である。（２２）式より，台車軌道
【式６３】
【０１３０】
が与えられれば，それを実現する制御入力
【式６４】
【０１３１】
を導出できる。
【０１３２】
５・２ シミュレーション及び搬送実験
図６（ａ）に示す障害物環境で，各節で述べた方法を統合してシミュレーションと搬送実験を行った。その結果を図１４に重ねて示す。３次元で表した図の上側にある軌道が台車のロープ繰り出し点，下側にある軌道が吊り荷重心を表し，細線がロープ，マップ中央に障害物，その周辺の床面に示したものは，吊り荷の半径分拡大した障害物領域を示している。２次元で表したグラフの中で，位置は吊り荷重心の位置を示し，速度と加速度は台車軌道の速度，加速度である。振れ角はロープのものである。実験結果より最大残留振動は０．０８１［ｒａｄ］であり，良好に残留振動の抑制ができている。位置決め誤差は１０［ｍｍ］でありシミュレーション結果と実験結果はほぼ一致している。また，最大速度，最大加速度制約を満たしている。
【０１３３】
６．スポット光位置への搬送実験
レーザーポインタのスポット光で目標搬送位置を照らし，吊り荷をスポット光の位置まで操作することを行う。目標搬送位置はカメラによって計測されたスポット光の位置とするが，Ｚ軸をカメラで認識した座標をそのまま目標搬送位置として使うと吊り荷下部が障害物に激突するため、安全マージンも含めて測定値に０．１５［ｍ］プラスして目標搬送位置とする。図１５はスポット光の位置へ，実際にクレーンを操作したときの実験データを示す。吊り荷はスポット光の上部に移動でき、残留振動の抑制を行いながら障害物の回避ができていることが図より確認できる。
【０１３４】
上記実施の形態において、２台のカメラを用いたが、２台以上のカメラを設けてスポット光を撮像することができる２台のカメラを使用することとすることもできる。
【０１３５】
発明の効果
カメラ２台でスポット光を計測する場合は１１ｍｍの誤差以内、カメラ１台でスポット光を計測する場合は１４ｍｍの誤差以内で３次元位置の計測ができることを実験により示した。ポテンシャル法を用いた経路計画、５次Ｂスプライン曲線の制御点と搬送時間をコンプレックス法による同時最適化、逆動力学計算による制振ＦＦ制御系を適用することで吊り荷の残留振動抑制と障害物回避を実現することができた。また、これらの要素技術を統合し、スポット光の位置へクレーンを操作することを行い、スポット光の位置へ残留振動抑制と障害物回避を行いながら位置決めができることを示した。
【図面の簡単な説明】
【０１３６】
【図１】本発明のクレーンシステムの斜視図。
【図２】図１のクレーンシステムにおけるスポット光測定環境を示す斜視図。
【図３】カメラ位置とスポット光位置の関係を示す概略図。
【図４】障害物環境を示す図。
【図５】スポット光の重心を求めるための説明図。
【図６】図６ａは３次元障害物環境を示す図であり、図６ｂは３次元拡散によるポテンシャル場を示す図。
【図７】拡散法における基本グリッドと周囲２６グリッドを示す図。
【図８】ポテンシャル法により得られた障害物回避径路を示す図。
【図９】折れ線近似法の概念を示す図。
【図１０】折れ線近似法の例を示す図。
【図１１】ラプラス方程式を用いた侵入制約を示す図。
【図１２】Ｂスプライン曲線による改善された搬送路を示す図。
【図１３】ＦＦ制御の概念を示す図。
【図１４】搬送制御の結果を示す図。
【図１５】スポット光位置への搬送実験結果を示す図。
【符号の説明】
【０１３７】
１ クレーンシステム
２ 台車
３ フレーム
４ ガーダ
５Ａ，５Ｂ タイミングベルト
６ コントローラ
７ ワイヤーロープ
１０ 搬送物
１１Ａ，１１Ｂ カメラ
【技術分野】
【０００１】
本発明は、天井クレーンの吊り荷（搬送物）の搬送に関し、特に、吊り荷を搬送開始位置からレーザーポイントにより指示した目標搬送位置まで自動的に搬送する方法及びシステムに関する。
【背景技術】
【０００２】
天井クレーンは搬送対象が３次元空間上を自由に移動できることや、搬送物の大きさや重量の制限が少ないので、搬送車等の他の搬送装置に比べ各種工場や倉庫など幅広い産業分野に利用されている。しかし、天井クレーンはロープで荷物を吊るす構造のため、クレーンの操作法や搬送の軌道などによっては荷振れが生じやすい。荷振れが生じた場合は地上の荷物との衝突や荷崩れが発生する危険性がある。このため従来は熟練したオペレータが高度な操作技術により荷振れを生じさせないように操作を行ってきた。しかし、近年の労働環境では人件費の削減や作業効率の向上が求められ、熟練したオペレータの育成は困難となっている。そのためクレーンの自動化を目指す様々な研究が行われている。
【０００３】
その研究の分野として、障害物を回避するための経路計画、搬送物の荷振れ抑制のための振れ止め制御といった研究が挙げられる。
【０００４】
また、振れ止め制御の研究として、西村他による非特許文献１のように、ゲインスケジューリングによる振れ止め制御、橋本他による非特許文献２のように、台車の移動速度と位置の偏差をフィードバッグにより振れ止めを行う研究などが行われていた。
【０００５】
経路計画に関する研究では、本発明者の一人である寺嶋他による非特許文献３のように、最小エネルギ、最短距離となる搬送経路を分枝限定法によって導出している。この方法は搬送領域内の障害物を多角形で近似し、その頂点をサブゴールとする搬送パターンのうち、実現可能で評価関数を最小とする経路を効率的に探索するものである。
【０００６】
しかし、完全自動制御では、オペレータがクレーンを管理しているコンピュータの指令装置に行き、その場所で目標搬送位置を指令することでクレーンを制御するため、オペレータが指令装置のある場所に行く必要がある。そのため、リアルタイムに位置決めを行うことが困難である。
【０００７】
そこで、本発明では操縦者がレーザーポインタによってクレーンに指示を与えることを考える。レーザーポインタで目標搬送位置へスポット光を指すことにより、カメラがスポット光の位置を計測し、その位置を目標搬送位置としてクレーンが障害物回避と振れ止め制御を行いながら自動で搬送するシステムを構築する。このようなシステムであればレーザーポインタによって目標搬送位置を指示するだけでクレーンが自動で荷物を搬送するため、オペレータの作業量軽減や搬送時間、安全性向上などにも大きく貢献できると考えられる。
【０００８】
従来技術を示す以下の非特許文献は参照のために本明細書に組み入れられる。
【０００９】
非特許文献
非特許文献１：西村秀和、種村英朗、野波健蔵、走行クレーンのロープ長変動に対するゲインスケジュール位置決め制御、日本機械学会論文集（Ｃ編）、Ｖｏｌ。６２、Ｎｏ。５９９、ｐｐ．２６９２−２６９７、（１９９６）
非特許文献２：橋本幸雄、土谷武士、松田俊彦、杉岡一郎、荷振れ情報を必要としないクレーンの吊り荷の振動抑制制御、計測自動制御学会論文集、Ｖｏｌ。３０、Ｎｏ。２、ｐｐ。１７２−１８０、（１９９４）
非特許文献３：兼重明宏、寺嶋一彦、鈴木薪雄、殷雷、障害物認識と経路計画を考慮した天井クレーンの自律化、“日本機械学会論文集（Ｃ）”、Ｖｏｌ。６４、Ｎｏ。６１８、（１９９８）、ｐｐ．４８７−４９４
非特許文献４：井口征士、３次元画像計測、昭晃堂、（１９９０）
非特許文献５：G.K. Schmidt, K.Azarm, Mobile robot path planning and execution based on a diffusion equation
strategy”, Advanced Robotics 7-5(1993),pp.479-490
非特許文献６：斎藤武雄、“数値伝熱学”、養賢堂、（１９８６）
非特許文献７：杉原厚吉、“グラフィックスの数理”、共立出版、（１９９５）
非特許文献８：David F. Rogers、 J.Alan Adams、山口富士夫、“コンピュータグラフィックス”、日刊工業新聞社（１９７９）
非特許文献９：須永照雄、“機械工学における最適化手法”、機械の研究、４１−８、（１９８９）、ｐｐ．８６７−８７２
非特許文献１０：柳井法貴、山本元司、毛利彰、“逆動力学計算に基づくクレーンのフィードバック制御”、計測自動制御学会論文集、３７−１１、（２００１）、ｐｐ．１０４８−１０５５
非特許文献１１：Yanai N, Yamamoto M, Mohri A, “Anti-Sway Control for Wire-Suspended Mechanism Based on Dynamics Compensation”, Proc IEEE Int Conf Rob Autom, 4,(2002),pp.4287-4292
非特許文献１２：高橋伸寿，中沢洋介，梅田和昇，レーザーポインタを用いたホームロボット操作システムの構築，日本機械学会ロボティスク・メカトロニクス講演会講演論文集，pp2P1-K03(1)-2P1-K03(2),(2002)
非特許文献１３：PAROMTCHIK.I.E, ASAMA.H,“Mobile robot guidance by means of a laser pointer”, Proc ASTED IntConf Model Identif Control, Vol.2,pp.718-721,(2001)
【発明の開示】
【００１０】
本発明のアプローチは次のとおりである。天井クレーンの目標移動位置を決定するためのスポット光を認識するシステムの構築を行う。スポット光は、オペレータがレーザーポインタを搬送物の目標搬送位置まで持って行き、レーザーポインタから照射したレーザー光により目標搬送位置の床面を数秒間照射してスポット光を形成し、基本的には、２台のカメラ（例えば、ＣＣＤカメラ）により前記スポット光を撮像し、カメラに接続されたコントローラによりスポット光の位置決定を行うものである。なお、対象の床面を照射するようにレーザーポインタをクレーン（例えば、クレーン台車）にとりつけることもできる。
【００１１】
また、カメラとスポット光を結ぶ直線上に障害物等が存在するために１台のカメラだけでしかスポット光を計測できない場合もあることを想定して、１台のカメラで３次元位置を計測するアルゴリズムを提案する。障害物回避経路の計算には３次元拡散方程式に基づくポテンシャル法を適用する。ポテンシャル法はグラフ理論やＧＡ等による経路計画に比べ、複雑な障害物環境にも適用が容易で、計算時間が短い等の利点を有すため、クレーンの煩雑な障害物環境に有効であると考えられる。次に得られた経路を折れ線近似法により改善を行うことで、不要な折れ点が少ない経路を導出する。次に得られた経路を５次Ｂスプライン曲線で表す。曲線を表すパラメータを操作量とし、装置制約と障害物回避制約を満たし、搬送時間を最小にする最適化問題をコンプレックス法により解くことで台車の制御入力を導出する。制御入力を逆動力学計算によるフィードフォワード制御系に入力することで、荷物の軌道追従と振動抑制を行う。
【００１２】
また、障害物位置情報は、非特許文献３に記載される光切断法により全て既知であることを前提とする。
【発明の実施するための最良の形態】
【００１３】
図１に本発明の実施の形態の天井クレーンシステム１の概要図を示す。該システムの天井クレーンは台車２と、台車２を平面内で走行自在に支持するフレーム３と含む。走行方向（Ｘ軸）方向はガーダ４が移動し、横行方向（Ｙ軸）はガーダ上を搬送物１０を吊り下げた台車２が移動することによりＸ、Ｙ方向への独立した搬送が可能である。台車の移動は台車に設けたＡＣサーボモータ（図示省略）の駆動をタイミングベルト５Ａを介し、コントローラ６からモータへの電圧指令を与え、台車速度を制御する。また、搬送物１０はワイヤーロープ７により吊り下げられ、ＡＣサーボモータの駆動により台車下部の巻き取りドラム（図示省略）を回転させることにより、上下方向（Ｚ軸）に移動する。台車、ガーダ、ヤイヤーロープ、搬送物、サーボモータの関係は公知であり、詳細に説明はしない。
【００１４】
Ｘ、Ｙ、Ｚ方向の最大移動距離は、本実施の形態においては、２.０ｍ、１.０ｍ、１.２ｍ、搬送物１０は質量３０Ｋｇの鋼塊である。ロープ７の振れ角の測定にはレーザーセンサ（ＫＥＹＥＮＣＥ、ＶＧ−０３５）をロープの付け根の近くに取り付けて行う。
【００１５】
クレーンのフレームに２台の白黒ＣＣＤカメラ（ＳＯＮＹ、ＸＣ−ＨＲ５８）１１Ａ，１１Ｂを固定して、レーザーポインタのスポット光の撮像のために利用する。カメラのレンズの前には色ガラスフィルタ（ＨＯＹＡ、Ｒ−６０）を取り付けることでレーザー光以外の外乱交を遮断する。画像処理装置には画像処理ボード（Ｌｉｎｘ、銀河＋＋Ｍ２）を利用する。カメラは台車可動範囲にあるＸ、Ｙ軸方向の床面を全て撮像でき、Ｚ軸方向は最低０.３ｍ、最高１.０ｍの高さから撮像できる。レーザーポインタはスポット径が３ｍ先で約７ｍｍ〜４０ｍｍの直径に調整できるもの（ＶＥＲＯＳ、ＬＥＰＯ６５０）を使用する。
【００１６】
コントローラ６は種々の演算を実行するコンピュータを含み、カメラに接続されカメラが撮像した像を解析しスポット光の位置を決定できるように構成されている。また、以下に説明する各処理はコントローラ６によってなされる。
【００１７】
１．スポット光位置の計測法
１・１ スポット光位置の求め方
本発明では図１に示すように、スポット光認識のために２つのカメラ１１Ａ，１１Ｂをクレーンのフレーム３に固定する。障害物の設置位置によってはカメラの死角が存在するため、図２を使って想定される状況を述べる。
【００１８】
図２のＡ領域のように、大きい方の障害物の上面Ａ１とその側部の床面Ａ２は両方のカメラで撮像できる。図２のＢ領域とＣ領域はカメラ１１Ａのみが撮像できる。１つのカメラでのみ表面のスポット光を撮像できるときは、床面の座標をＺ＝０として２次元の（Ｘ、Ｙ）座標をコントローラ６で決定できるが、図２のＣ領域のスポット光により、３次元のクレーン座標（Ｘ、Ｙ、Ｚ）を決定することは不可能である。しかし、本発明では光切断法により全て把握されている障害物位置情報を用いることで１つのカメラの撮像により決定された（Ｕ、Ｖ）座標から３次元のクレーン座標（Ｘ、Ｙ、Ｚ）を決定することができる。
【００１９】
１・２ ２台のカメラの場合
カメラが２台ともスポット光を認識できる場合は本節で述べる方法によりスポット光のクレーン座標を求める。図２のカメラ１１ＡのカメラのパラメータをＣＡ１〜ＣＡ１１、カメラ座標を（ＵＡ、ＶＡ）、カメラ１１１ＢのカメラのパラメータをＣＢ１〜ＣＢ１１、カメラ座標を（ＵＢ、ＶＢ）、スポット光の座標を（Ｘ，Ｙ，Ｚ）とすると，非特許文献４に記載されるように、次式の関係が成り立つ。次式を行列で表したあと，一般逆行列を用いて最小二乗解を求めることで（Ｘ，Ｙ，Ｚ）を求める。
【式１】
【００２０】
１・３ １台のカメラの場合
障害物によってカメラの死角が生じる。このような場合はカメラ１台しかスポット光を認識できない場合もある。このときは（２）式によりスポット光の２次元クレーン座標を求める。（２）式はＺ＝０のときの（１）式を変形させた式である。（２）式はカメラ１１Ａのものであるが，カメラ１１Ｂのものも同様な式で求めることができる。
【式２】
【００２１】
１つのカメラで３次元位置を求めるアルゴリズム
図２のＣ領域（小さな方の障害物の上面）に吊り荷を搬送したい場合の例を図３に示す。Ｃ領域は、先に述べたように、Ａ１領域を有する大きい方の障害物にじゃまされてカメラ１１Ｂでは撮像できないが、カメラ１１Ａで撮像可能である。
【００２２】
図３に破線で示すように斜め上方からにレーザー光線をＣ領域に照射した場合を考える。スポット光がＣ領域に形成されるので、カメラ１１Ａにより該ポット光を撮像する。後に説明する方法（スポット光重心を求めるアルゴリズム）により、撮像したスポット光画像からスポット光の重心Ｂを画像的に決定し、コントローラ６を介してカメラ１１Ａの光軸をＢ点に合わせる。カメラ１１Ａの位置Ｃは既知であり、その座標は（Ｘ３，Ｚ３）である。Ｂ点の未知の座標を（Ｘ２，Ｚ２）とする。カメラ１１Ａの光軸と床面（２つの障害物が載っている面）との交点Ａの未知の座標を（Ｘ1，Ｚ1）とする。Ｂ（Ｘ２，Ｚ２）、すなわち、目標搬送位置を図３に関して、次に述べる方法で求める。
【００２３】
１）最初に、（２）式により座標Ａ（Ｘ１，Ｚ１）を求める。
【００２４】
２）既知である座標Ｃ（Ｘ３，Ｚ３）を利用して，障害物のＺ座標を探索するＺを，Ｚ＝Ｚ３として定義する。
【００２５】
３）Ｚ−１０［ｍｍ］を計算し，Ｘ方向を探索する係数Ｘを以下の（３）式により求める。
【式３】
【００２６】
４）３）を数回計算する。
【００２７】
５）障害物位置情報とＸ，Ｚを比較し，Ｘ＜Ｘ２，Ｚ＜Ｚ２が成立する直前のＸ，Ｚを取得して終了する。
【００２８】
上記アルゴリズムのステップ１）で床面上の点Ａの座標（Ｘ１，Ｚ１）は、座標Ｂ（Ｘ２，Ｚ２）とＡ（Ｘ１，Ｚ１）はカメラの画像面上では同じＵ，Ｖ座標にあるため，Ｚ＝０という仮定と（２）式を用いることで求まるものである。上記３）を数回計算することで，最初はＸ＝Ｘ３，Ｚ＝Ｚ３であったのが徐々にＸ，ＺはＸ２，Ｚ２に近づいていき，最終的にＸ＜Ｘ２，Ｚ＜Ｚ２が成立するように変化する。上記の計算により，障害物上の目標搬送位置の座標Ｂ（Ｘ２，Ｚ２）を求めることができる。
【００２９】
説明を簡便にするために、図３に示すＸ−Ｚ平面のみに関して説明したが、Ｙ−Ｚ平面に関しても同様であり、この計算法を使うことで障害物位置情報とスポット光の画像から３次元位置を求めることができる。この計算法を使うメリットとしては，カメラの画像面の座標と３次元座標との対応付けを行う必要がなくなるため，障害物の位置を変更するたびに３次元座標との対応付けを行う手間や，対応付けのためのプログラム変更の手間を省くことができる。
【００３０】
上記（３）式は空間上の２点間を結ぶ直線の方程式を変形させたものである。なお，この方法は光切断法により障害物位置情報が全て既知であるという前提のもとで行っている。
【００３１】
２．スポット光位置の計測実験
２・１ ２台のカメラによる計測校正済みカメラで静止した物体の座標を求めることで精度の確認を行う。ここで静止した物体の座標を求めているのは，レーザーポインタのスポット光ではｍｍ単位での位置決めは困難であり，計測誤差の確認には静止した物体の座標を求める方が容易であるためである。表１には実際に３次元座標を求めたときの例を示し，表の左に本来の３次元座標，右に計測結果を示す。単位はｍｍである。最大で１１ｍｍの誤差、最小で０ｍｍの誤差であった。
【表１】
【００３２】
２・２ １台のカメラによる計測
図４に示す障害物環境下で、校正済みカメラで静止した物体の座標を求めたときの計測結果を表２に示す。表の左に本来の３次元座標、右に計測結果を示す。単位はｍｍである。撮像に使ったカメラはカメラ１１Ａであるが、カメラ１１Ｂで撮像した場合も同様な結果になるため省略する。この結果より３次元座標を決定できた。最大で１４ｍｍの誤差、最小で０ｍｍの計測誤差であった。
【表２】
【００３３】
２・３ スポット光重心の導出
一般的にスポット光は大きさを持っている。レーザーポインタの当て方によっては大きな楕円となってしまい、楕円のどの位置を計測するかによって測定値が変わる問題が生じる。そこで本発明ではスポット光の重心位置を求めることでこの問題を解決する。スポット光の重心を求める方法としては、下に述べるアルゴリズムを用いる。
【００３４】
スポット光重心を求めるアルゴリズム：
１）カメラで撮像した画像から輝度値を取得し、輝度値２００以上の座標（図５の例では最も色の濃い領域）を取得する。
【００３５】
２）輝度値２００以上の座標（上記最も色の濃い領域）の中で、最も上下左右にある４つの座標（Ａ、Ｂ、Ｃ、Ｄ）を取得。
【００３６】
３） （Ａ＋Ｄ）／２と（Ｂ＋Ｃ）／２を計算してＥの座標を求める。この重心を求める方法は公知であり、一般に使用されている。
【００３７】
輝度値は０〜２５５段階に分かれる。コンクリートなどの画像は輝度値２００未満であるが、スポット光は輝度値２００以上となるので、撮像した画像から輝度値２００以上の画像を取得することでスポット光のみを取得できる。スポット光周辺（図５の例では色の薄い領域と周辺の背景）の輝度値は２００未満であるため、輝度値を取得する際に排除することができる。この処理によって撮像した画像はスポット光の画像（図５の例では色の濃い領域）のみが残るため、座標（Ａ、Ｂ、Ｃ、Ｄ）の位置を判別することが容易となる。
【００３８】
この方法でスポット光の位置を求める実験を行った。スポット光は十分な輝度を持ち、容易にカメラで認識ができた。
【００３９】
３．障害物回避経路の導出
３・１ ポテンシャル法
ポテンシャル法とは、非特許文献５に説明されるように、拡散方程式を用い、搬送領域内に仮想的な拡散物質を拡散させ、その濃度勾配（ポテンシャル場）を用いて経路を得るものである。３次元拡散方程式は次式となる。
【式４】
【００４０】
差分法により数値計算を行うため，（４）式を差分化すると、非特許文献６に示されるように、次式となる。
【式５】
【００４１】
さらに、境界条件として、以下の（６）式
【式６】
【００４２】
を恒久的に与え、それ以外のグリッドの初期条件として以下の（７）式
【式７】
【００４３】
を与える。荷物の大きさを無視するために，荷物を円柱と仮定し，荷物半径だけ障害物を拡大するものとした。荷物下端の位置を荷物経路のＺ座標とするため、障害物はＸ−Ｙ軸方向への拡大処理のみ行う。
【００４４】
図６（ａ）に示す３次元障害物環境に（５）〜（７）式を用いてポテンシャル場を生成した例を図６（ｂ）に示す。ここで、スタート地点Ｓを（０．１［ｍ］，０．１［ｍ］，０．３［ｍ］）、ゴール地点Ｇを（１．９［ｍ］，０．９［ｍ］，０．３［ｍ］）、搬送物半径を０．１５［ｍ］（グリッド幅Δｈ＝０．０５［ｍ］の場合の３グリッド相当）として障害物を拡大した。図６（ａ）の障害物周辺に拡大された障害物領域を示す。ただし，地面（Ｚ＝０［ｍ］）にのみ拡大障害物領域を示すものとする。図６より境界条件であるゴール地点で濃度Ｃ＝１，障害物領域内で濃度Ｃ＝０，障害物領域外ではゴール地点に近接するほど濃度は１に近く，離れるほど濃度は低下する。なお，実験の際には障害物の拡大処理を０．２［ｍ］（荷物半径０．１５［ｍ］＋安全余裕０．０５［ｍ］）とする。従って，スタート地点（図７に黒丸で示す基本グリッド(i,j,k)からその周囲２６グリッド（図中。印）の濃度を参照し，最大濃度となるグリッドを選択することで，障害物に衝突せずゴール地点にたどり着くことができる。このとき選択したグリッドを連結して得られる経路が障害物回避経路となる。図８に回避経路を導出した例を示す。実線が荷物の重心位置を示す回避経路である。
【００４５】
ここで，拡散方程式に基づくポテンシャル法の手順を以下にまとめる。
【００４６】
拡散方程式に基づくポテンシャル法：
１）対象となる３次元搬送領域（Ｘ，Ｙ，Ｚ）をグリッド幅Δｈのメッシュで区切り、障害物を該当するグリッドに配置する。
【００４７】
２）障害物を搬送物半径だけ拡大する。
【００４８】
３）（６）、（７）式により全グリッドの初期濃度Ｃo,ｉ,ｊ,ｋを与える。
【００４９】
４）（５）式を用いて境界条件を除く全グリッドの濃度Ｃｔ,ｉ,ｊ,ｋを更新する。
【００５０】
５）（８）式の終了条件を満足する場合には６）へ。満足しない場合には４）へ。
【００５１】
６）与えられたスタートグリッドＳを選択グリッドＰとする。
【００５２】
７）選択グリッドＰの周囲２６グリッドの中から最大濃度グリッドを選択し、選択グリッドＰをストックし更新する。
【００５３】
８）選択グリッドＰの濃度Ｃ＝１（ゴール地点Ｇ）であれば終了。それ以外は７）へ。
【００５４】
この手順においてストックされた選択グリッドＰが回避経路となる。なお、拡散終了条件には次式を用いる。
【式８】
【００５５】
ここで、Ｃｔ、Ｓは時刻ｔにおけるスタート地点Ｓの濃度である。（８）式はスタート地点における各計算ステップごとの濃度の変化比率を示している。この終了条件は定常するまでの拡散回数が障害物環境によって異なるため導入した。εＣｓは拡散プロセスの定常状態を判定する閾値であり、εＣｓ＝０．０１とし、拡散パラメータｒは０．０１とした。
【００５６】
３・２ 折れ線近似法
図８に示すように、ポテンシャル法によって得られた経路は折れ点の多い経路となる。台車軌道は折れ点の影響を受けやすく、不要な折れ点は搬送時間の増大を招く。そのため、最大濃度グリッドの点群を折れ線近似法により直線で近似する。この手法により不必要な折れ点を少なくする。近似の際には、経路が障害物領域に侵入しないことを条件に近似を行う。図９に障害物環境を用いた折れ線近似法の概要を示す。図中＿印で示されるスタート地点を線分の始点とする。線分の終点をゴール地点から経路データの点群（同図。印）を走査していき、障害物と衝突しない直線を探索する。図中の破線は障害物領域へ進入してしまうため選択されない。障害物と衝突しない直線を決定したならば、その直線の終点を新たに始点として直線を探索する。この操作を繰り返し行うと図１０に示すような近似結果が得られる。同図破線がポテンシャル法により得られた経路を表し、実線が直線近似を行った近似経路である。近似経路の折れ点数は１４点から４点に減少し、搬送距離が短縮されていることが分かる。以下に折れ線近似法の手順を示す。
【００５７】
折れ線近似法：
１）ポテンシャル法により得られた選択グリッドをＰｉ（ｉ＝１、・・・、ｎ）として、ｓ＝１、ｇ＝ｎとおく。
【００５８】
２）グリッドＰｓからグリッドＰｇまでの直線が障害物領域内を通過するか判定。またはＰｊ（ｊ＝ｓ、・・・、ｇ）の点群の障害物領域周辺からの位置が許容最大値ｅｍａｘ内であるかを判定。
【００５９】
３）上記直線が障害物領域を通過し、または上記点群が許容最大値を超える場合はｇ＝ｇ−１として２）へ。それ以外の場合、Ｐｇを折れ点としてストックし４）へ。
【００６０】
４）ｇ＝ｎなら終了、ｇがｎでないならｓ＝ｇ、ｇ＝ｎとして２）へ。
【００６１】
４．各種制約条件を考慮した荷物軌道の導出
４・１ ５次Ｂスプライン曲線
逆動力学計算を用いた制御系において、荷物軌道は４階微分が可能であることが求められるため、本発明では５次Ｂスプライン曲線を用いて荷物軌道を表現する。区間[ｉ,ｉ＋１]、（ｉ＝０、・・・、Ｎ−１）における５次Ｂスプライン曲線で表現された荷物軌道
【式９】
【００６２】
と時刻ｔ（ｓ）を次式で定義する。
【式１０】
【００６３】
本発明では折れ線近似法により得られた折れ点を用いることとする。ｓは０≦ｓ＜１とする曲線パラメータ，Ｎｊ（ｓ）は５次Ｂスプライン基底関数であり，deBoor-Coxの公式（非特許文献７及び８）により次式のように導出される。
【式１１】
【００６４】
従って，荷物軌道
【式１２】
【００６５】
は重みＮｊ（ｓ）を与えた周囲６点の制御点の線形結合により求められる。なお，（１０）式のスプライン基底関数Ｎｊ（ｓ）はｓの５次式で与えられることから，得られる荷物軌道
【式１３】
【００６６】
は４階微分可能となる。
【００６７】
４・２ 最適制御問題の定式化
制御点及び終端時刻を記述する制御点ベクトルを
【式１４】
【００６８】
と定義し，各種制約条件を考慮して評価関数を定式化し、最適解を導出する。制約条件に応じて与えるペナルティ項を付加した評価関数Ｊを次式で定義する。
【式１５】
【００６９】
ここで，ｌは制約条件の数，Ｗはペナルティ項の重み係数である。
【００７０】
（１４）式は制約条件下で高速な軌道を導出することを目的とした評価関数である。ペナルティ項の重みＷは１００００とする。Ｗは搬送時間ｔｆに対して十分に大きな値を与えることで，制約条件を満足する軌道が導出できる。また，ｈｉ（ｔ）はペナルティ関数であり，常に正値でなければならないので，制約条件ｇｉ（ｔ）に応じて次式で与える。
【式１６】
【００７１】
（１２）式では制約条件を満足しないときにのみペナルティ項が加算される。従って，制約条件を満足しない軌道は最適化過程で排除され，制約を満足し，かつ搬送時間の短い軌道が得られる。
【００７２】
４・３ モータの速度，加速度制約
次に各種制約条件について述べる。モータには有限の速度，加速度を有するので，モータの装置制約を考慮する必要がある。最適制御問題における制約条件をｇｉ（ｔ）≧０の形で表すと，台車速度
【式１７】
【００７３】
及び台車加速度
【式１８】
【００７４】
の制約は次式となる。
【式１９】
【００７５】
Ｙ軸についても同様である。Ｚ軸についてもモータの装置制約を考える。Ｚ軸のロープ巻き上げ下げ速度
【式２０】
【００７６】
及びロープ巻き上げ下げ加速度
【式２１】
【００７７】
の制約は次式となる。
【式２２】
【００７８】
制約条件として，台車速度
【式２３】
【００７９】
及び台車加速度
【式２４】
【００８０】
とした。また，残留振動抑制のためには搬送スタート地点及びゴール地点において荷物と台車は停止していなければならない。そのため，搬送スタート地点及びゴール地点では
【式２５】
【００８１】
の条件が与えられる。
【００８２】
４・４ ラプラス方程式を用いた進入抑制制約
荷物の障害物領域内への進入を抑制する制約としてラプラス方程式を用いた障害物回避のための制約条件を利用する。この制約条件を利用することで，求めた荷物軌道が障害物領域内に進入していないかを評価できる。次の手順で制約のための荷物軌道
【式２６】
【００８３】
により定まるポテンシャル場
【式２７】
【００８４】
を生成する。搬送領域内に２つのポテンシャル場Ｃｏ，Ｃｎを（１５）式のラプラス方程式により導出する。
【式２８】
【００８５】
ここで，初期条件としてＣｏ，Ｃｎ＝ｅｘｐ１，それぞれの境界条件として（１６）式
【式２９】
【００８６】
を用いる。
【００８７】
（１６）式の境界条件より，Ｃｏは障害物領域内でのみ値を有するポテンシャル場であり，Ｃｎは障害物領域内外でのみ値を有するポテンシャル場となる。得られた２つのポテンシャル場を用いてポテンシャル制約Ｃｒを求める。
【式３０】
【００８８】
ここでｌｏｇをとるのはＣｏ及びＣｎの指数的な変化を考慮するためである。図１１（ａ）に障害物環境、図１１（ｂ）にラプラス方程式により生成されたポテンシャル制約Ｃｒを示す。同図より生成されたポテンシャル場Ｃｒは必ず障害物領域内で正、領域外で負、境界で零となることが確認できる。また、搬送領域全域で勾配を有し、障害物が密集する領域ほどポテンシャル値Ｃｒは大きくなっている。ここで、Ｃｒが負であれば障害物領域に侵入しないことから、進入抑制のための制約条件は次式で与えられる。
【式３１】
【００８９】
４・５ コンプレックス法
（９）、（１０）式で、４階微分可能な荷物軌道
【式３２】
【００９０】
は表現できる。しかし、（１０）（１１）式において制御点
【式３３】
【００９１】
と搬送終端時刻ｔｆを決定する必要がある。従って、これらの変数を操作量とし、障害物回避等の各種制約条件を満足する最適制御問題を考える。そこで、制御点及び終端時刻を記述する制御点ベクトルを
【式３４】
【００９２】
と定義し、これを非線形最適化手法の一種であるコンプレックス法（非特許文献９）により最適化する。制御点の数を折れ線近似法により得られた折れ点の数Ｎとすれば、始端と終端の位置は固定されるため、
【式３５】
【００９３】
は３（Ｎ−２）＋１の最適化変数を有する。また、コンプレックス法における初期点の数Ｍは最適化変数の２倍程度にすることが好ましいとされているので、Ｍ＝６（Ｎ-２）＋１個の初期点を与えることとした（非特許文献９）。制御点ベクトル
【式３６】
【００９４】
をコンプレックス法により改善する手順を以下に示す。
【００９５】
コンプレックス法による最適化アルゴリズム：
１） 折れ点近似法により得られた制御点ベクトルを
【式３７】
【００９６】
とし、残りのＭ−１個の制御点ベクトル
【式３８】
【００９７】
の要素を次式により決定する。
【式３９】
【００９８】
ここで、ｉ＝１，・・・，Ｎ，２，・・・，Ｍ、Ｄｘ，Ｄｙ，Ｄｚ，Ｄｔｆは各制御点の探索域に対応して設定する値、ｒは区間[−０.５,０.５]の一様乱数である。
【００９９】
２） 各制御点ベクトルで定まる軌道に対して評価関数を計算し、評価値の最大値ＪＨを与える制御点ベクトル
【式４０】
【０１００】
と最小値ＪＬを与える制御点ベクトル
【式４１】
【０１０１】
を求める。
【０１０２】
３）εを収束の判定定数としてＪＨ−ＪＬ≦εの場合は終了、ＪＨ−ＪＬ＞εの場合は４）へ。
【０１０３】
４）最大点
【式４２】
【０１０４】
を除く制御点ベクトルの重心
【式４３】
【０１０５】
を求める。次式
【式４４】
【０１０６】
により最大点
【式４５】
【０１０７】
と重心
【式４６】
【０１０８】
とを結ぶ直線上で改良点
【式４７】
【０１０９】
を求め、その評価値ＪＣとおく。
【０１１０】
５）ＪＣ＜ＪＨならば
【式４８】
【０１１１】
を
【式４９】
【０１１２】
で置き換え、２）へ。ＪＣ≧ＪＨならばεαを十分小さな値として、α≧εαならαをα・βで置き換え４）へ、α＜εαならαを初期値に戻し、
【式５０】
【０１１３】
を
【式５１】
【０１１４】
に置き換え４）へ。
【０１１５】
ここで、図１０に示すように上記手法の軌道生成のシミュレーションを行う。条件として初期制御点数と初期値は障害物環境を用いた折れ線近似法により得られた折れ点を与えるものとする。αの初期値は１．３、βの初期値は０．５とする（非特許文献９）。また、探索域Ｄｘ＝Ｄｙ＝Ｄｚ＝０.１ｍ、Ｄｔｆ＝１ｓとし、ε＝０．０１、εα＝０．０１とした。このときの初期制御点及び改善後の制御点の位置を図１２に示す。図より改善後の制御点は搬送領域外に位置しているが、この制御点より得られるＢスプライン軌道はラプラスポテンシャル場による制約条件により搬送領域内でかつ障害物回避を行う。
【０１１６】
実際に軌道生成シミュレーション結果を行った結果を図１２の太実線に示す。折れ線であった経路（図中破線）が曲線で表され、さらに障害物を回避する形となっていることがわかる。
【０１１７】
５．制振制御と軌道追従のための制御系の構築
５・１ 逆動力学計算によるＦＦ制御
本発明では、荷物の軌道追従、振動抑制を非特許文献１０に記載される逆動力学計算によるフィードフォワード制御により行う。この手法は荷物軌道
【式５２】
【０１１８】
を実現する台車軌道
【式５３】
【０１１９】
を力の釣り合いから得られる以下の（２１）式
【式５４】
【０１２０】
によって導出する手法である。ここで，ｇは重力加速度である。さらに，この台車軌道をモータの逆モデルに入力することで，実際の天井クレーンの台車軌道及び荷物軌道が
【式５５】
【０１２１】
となるＦＦ制御入力
【式５６】
【０１２２】
を得る。ＦＦ制御入力導出の過程は図１３となる。ただし，（４３）式及びモータの逆モデルはそれぞれ入力の２階微分を含むことから，荷物軌道は４階微分可能なものしか実現することができない。そのため，本発明では５次Ｂスプライン曲線を導入することで４回微分可能な荷物軌道
【式５７】
【０１２３】
を得ている。
【０１２４】
次に，天井クレーンのモータを１次遅れ系と仮定すると，与えられた台車軌道
【式５８】
【０１２５】
を実現する制御入力
【式５９】
【０１２６】
は次式により求められる。
【式６０】
【０１２７】
ここで，
【式６１】
【０１２８】
は各軸のモータゲインを成分とする対角行列，
【式６２】
【０１２９】
は各軸のモータ時定数を成分とする対角行列である。（２２）式より，台車軌道
【式６３】
【０１３０】
が与えられれば，それを実現する制御入力
【式６４】
【０１３１】
を導出できる。
【０１３２】
５・２ シミュレーション及び搬送実験
図６（ａ）に示す障害物環境で，各節で述べた方法を統合してシミュレーションと搬送実験を行った。その結果を図１４に重ねて示す。３次元で表した図の上側にある軌道が台車のロープ繰り出し点，下側にある軌道が吊り荷重心を表し，細線がロープ，マップ中央に障害物，その周辺の床面に示したものは，吊り荷の半径分拡大した障害物領域を示している。２次元で表したグラフの中で，位置は吊り荷重心の位置を示し，速度と加速度は台車軌道の速度，加速度である。振れ角はロープのものである。実験結果より最大残留振動は０．０８１［ｒａｄ］であり，良好に残留振動の抑制ができている。位置決め誤差は１０［ｍｍ］でありシミュレーション結果と実験結果はほぼ一致している。また，最大速度，最大加速度制約を満たしている。
【０１３３】
６．スポット光位置への搬送実験
レーザーポインタのスポット光で目標搬送位置を照らし，吊り荷をスポット光の位置まで操作することを行う。目標搬送位置はカメラによって計測されたスポット光の位置とするが，Ｚ軸をカメラで認識した座標をそのまま目標搬送位置として使うと吊り荷下部が障害物に激突するため、安全マージンも含めて測定値に０．１５［ｍ］プラスして目標搬送位置とする。図１５はスポット光の位置へ，実際にクレーンを操作したときの実験データを示す。吊り荷はスポット光の上部に移動でき、残留振動の抑制を行いながら障害物の回避ができていることが図より確認できる。
【０１３４】
上記実施の形態において、２台のカメラを用いたが、２台以上のカメラを設けてスポット光を撮像することができる２台のカメラを使用することとすることもできる。
【０１３５】
発明の効果
カメラ２台でスポット光を計測する場合は１１ｍｍの誤差以内、カメラ１台でスポット光を計測する場合は１４ｍｍの誤差以内で３次元位置の計測ができることを実験により示した。ポテンシャル法を用いた経路計画、５次Ｂスプライン曲線の制御点と搬送時間をコンプレックス法による同時最適化、逆動力学計算による制振ＦＦ制御系を適用することで吊り荷の残留振動抑制と障害物回避を実現することができた。また、これらの要素技術を統合し、スポット光の位置へクレーンを操作することを行い、スポット光の位置へ残留振動抑制と障害物回避を行いながら位置決めができることを示した。
【図面の簡単な説明】
【０１３６】
【図１】本発明のクレーンシステムの斜視図。
【図２】図１のクレーンシステムにおけるスポット光測定環境を示す斜視図。
【図３】カメラ位置とスポット光位置の関係を示す概略図。
【図４】障害物環境を示す図。
【図５】スポット光の重心を求めるための説明図。
【図６】図６ａは３次元障害物環境を示す図であり、図６ｂは３次元拡散によるポテンシャル場を示す図。
【図７】拡散法における基本グリッドと周囲２６グリッドを示す図。
【図８】ポテンシャル法により得られた障害物回避径路を示す図。
【図９】折れ線近似法の概念を示す図。
【図１０】折れ線近似法の例を示す図。
【図１１】ラプラス方程式を用いた侵入制約を示す図。
【図１２】Ｂスプライン曲線による改善された搬送路を示す図。
【図１３】ＦＦ制御の概念を示す図。
【図１４】搬送制御の結果を示す図。
【図１５】スポット光位置への搬送実験結果を示す図。
【符号の説明】
【０１３７】
１ クレーンシステム
２ 台車
３ フレーム
４ ガーダ
５Ａ，５Ｂ タイミングベルト
６ コントローラ
７ ワイヤーロープ
１０ 搬送物
１１Ａ，１１Ｂ カメラ
【特許請求の範囲】
【請求項１】
コントローラを介して自動運転される天井クレーンを用いて搬送物を搬送開始位置から目標搬送位置の真上までの３次元空間における搬送径路に沿って自動的に搬送する方法であって：
スポット光を撮像するための複数のカメラを設置し；
レーザーポインタによりレーザー光線を目標搬送位置床表面に照射してスポット光を生成し；
該生成されたスポット光を少なくとも１台のカメラで撮像し、該撮像データを利用してスポット光重心位置の３次元空間座標を決定し；
前記３次元空間座標を前記目標搬送位置データとして利用して前記コントローラによって前記搬送径路を決定し、該搬送径路に沿って前記搬送物を前記搬送開始位置から前記目標搬送位置の真上まで自動的に搬送する；
ことを含んでなる自動搬送方法。
【請求項２】
請求項１に記載の自動搬送方法であって、少なくとも２台のカメラを設置し、前記少なくとも２台のカメラのうちの任意の２台のカメラと前記スポット光の間に障害物が存在しない場合、該２台のカメラにより前記スポット光を撮像し該撮像データを利用してスポット光重心位置の３次元空間座標を決定することを含み、前記少なくとも２台のカメラのうち１台のカメラのみが前記スポット光を撮像でき、他のカメラが障害物のために前記スポット光を撮像できないとき、前記スポット光を撮像できる１台のカメラにより前記スポット光を撮像し該撮像データを利用してスポット光重心位置の３次元空間座標を決定することを含んでなる自動搬送方法。
【請求項３】
請求項２に記載の自動搬送方法であって、前記スポット光を撮像できるカメラが１台であるとき、前記スポット光を撮像できる該１台のカメラによる前記撮像データと、前記カメラの位置の公知の座標と、光切断法により予め求めておいた前記障害物の位置情報とを利用してスポット光重心位置の３次元座標を決定することを含んでなる自動搬送方法。
【請求項４】
請求項３に記載の自動搬送方法であって、前記搬送開始位置と、前記スポット光重心位置とを結ぶ直線上に障害物が存在するとき、３次元拡散方程式に基づくポテンシャル法を適用して前記障害物の３次元障害物を回避するための折れ線状の障害物回避径路を計算し、前記搬送物を該障害物回避径路上で搬送する自動搬送方法。
【請求項５】
請求項４に記載の自動搬送方法であって、前記障害物回避径路に関して折れ線近似法を適用して前記障害物回避径路の折れ線の数を減少した搬送径路を決定することを含んでなる自動搬送方法。
【請求項６】
請求項５に記載の自動搬送方法であって、前記折れ線の数を減少した搬送径路を５次Ｂスプライン曲線で表し、該曲線を搬送径路とすることを含んでなる自動搬送方法。
【請求項７】
請求項４に記載の自動搬送方法であって、ラプラス方程式を用いた障害物回避のための制約条件を利用することを含んでなる自動搬送方法。
【請求項８】
請求項５に記載の自動搬送方法であって、前記折れ線の数を減少した搬送径路にコンプレックス法を適用して搬送径路を非線形最適化することを含んでなる自動搬送方法。
【請求項９】
請求項６に記載の自動搬送方法であって、前記５次Ｂスプライン曲線の搬送径路に関して逆動力学計算によるＦＦ制御を行うことを含んでなる自動搬送方法。
【請求項１０】
レーザーポインタによって搬送物の目標搬送位置の床表面にレーザー光線を照射して生成したスポット光を利用し、天井クレーンを用いて搬送物を搬送開始位置から目標搬送位置の真上までの３次元空間における搬送径路に沿って自動的に搬送するクレーンシステムであって：
搬送物を垂直方向に移動させることができ、かつ、水平面内で移動可能な台車と、該台車を水平移動自在に支持するフレームを含む天井クレーンと、
前記スポット光を撮像する少なくとも１台のカメラと；
前記少なくとも１台のカメラに接続され前記撮像したスポット光を利用してスポット光重心位置の３次元空間座標を決定するコントローラであって、前記３次元空間座標を前記目的搬送位置として前記天井クレーンの駆動装置に指令するコントローラと；
を含んでなるクレーンシステム。
【請求項１１】
請求項１０に記載のクレーンシステムであって、前記少なくとも１台のカメラはＣＣＤカメラであるクレーンシステム。
【請求項１２】
請求項１０に記載のクレーンシステムであって、前記少なくとも１台のカメラを前記天井クレーンの前記フレームに固定して設けたクレーンシステム。
【請求項１３】
請求項１０に記載のクレーンシステムであって、２台のカメラを有し、該２台のカメラと前記スポット光の間に障害物が存在しない場合、前記コントローラは、前記２台のカメラにより撮像した前記スポット光の撮像データを利用してスポット光重心位置の３次元空間座標を決定し、前記２台のカメラのうち１台のカメラのみが前記スポット光を撮像でき、他のカメラが障害物のために前記スポット光を撮像できないとき、前記１台のカメラにより撮像したスポット光の撮像データを利用してスポット光重心位置の３次元空間座標を決定するクレーンシステム。
【請求項１４】
請求項１３に記載のクレーンシステムであって、前記スポット光を撮像できるカメラが１台であるとき、前記コントローラは、前記スポット光を撮像できる該１台のカメラによる前記撮像データと、該カメラの位置の公知の座標と、光切断法により予め求めておいた前記障害物の位置情報とを利用してスポット光重心位置の３次元座標を決定するクレーンシステム。
【請求項１５】
請求項１４に記載のクレーンシステムであって、前記搬送開始位置と、前記スポット光重心位置とを結ぶ直線上に障害物が存在するとき、前記コントローラは、３次元拡散方程式に基づくポテンシャル法を適用して前記障害物の３次元障害物を回避するための折れ線状の障害物回避径路を計算し、該障害物回避径路を前記搬送径路として前記天井クレーンの駆動装置に指令するクレーンシステム。
【請求項１６】
請求項１４に記載のクレーンシステムであって、前記コントローラは、前記障害物回避径路に関して折れ線近似法を適用して前記障害物回避径路の折れ線の数を減少した搬送径路を決定し、該決定した搬送径路を前記天井クレーンの駆動装置に指令するクレーンシステム。
【請求項１】
コントローラを介して自動運転される天井クレーンを用いて搬送物を搬送開始位置から目標搬送位置の真上までの３次元空間における搬送径路に沿って自動的に搬送する方法であって：
スポット光を撮像するための複数のカメラを設置し；
レーザーポインタによりレーザー光線を目標搬送位置床表面に照射してスポット光を生成し；
該生成されたスポット光を少なくとも１台のカメラで撮像し、該撮像データを利用してスポット光重心位置の３次元空間座標を決定し；
前記３次元空間座標を前記目標搬送位置データとして利用して前記コントローラによって前記搬送径路を決定し、該搬送径路に沿って前記搬送物を前記搬送開始位置から前記目標搬送位置の真上まで自動的に搬送する；
ことを含んでなる自動搬送方法。
【請求項２】
請求項１に記載の自動搬送方法であって、少なくとも２台のカメラを設置し、前記少なくとも２台のカメラのうちの任意の２台のカメラと前記スポット光の間に障害物が存在しない場合、該２台のカメラにより前記スポット光を撮像し該撮像データを利用してスポット光重心位置の３次元空間座標を決定することを含み、前記少なくとも２台のカメラのうち１台のカメラのみが前記スポット光を撮像でき、他のカメラが障害物のために前記スポット光を撮像できないとき、前記スポット光を撮像できる１台のカメラにより前記スポット光を撮像し該撮像データを利用してスポット光重心位置の３次元空間座標を決定することを含んでなる自動搬送方法。
【請求項３】
請求項２に記載の自動搬送方法であって、前記スポット光を撮像できるカメラが１台であるとき、前記スポット光を撮像できる該１台のカメラによる前記撮像データと、前記カメラの位置の公知の座標と、光切断法により予め求めておいた前記障害物の位置情報とを利用してスポット光重心位置の３次元座標を決定することを含んでなる自動搬送方法。
【請求項４】
請求項３に記載の自動搬送方法であって、前記搬送開始位置と、前記スポット光重心位置とを結ぶ直線上に障害物が存在するとき、３次元拡散方程式に基づくポテンシャル法を適用して前記障害物の３次元障害物を回避するための折れ線状の障害物回避径路を計算し、前記搬送物を該障害物回避径路上で搬送する自動搬送方法。
【請求項５】
請求項４に記載の自動搬送方法であって、前記障害物回避径路に関して折れ線近似法を適用して前記障害物回避径路の折れ線の数を減少した搬送径路を決定することを含んでなる自動搬送方法。
【請求項６】
請求項５に記載の自動搬送方法であって、前記折れ線の数を減少した搬送径路を５次Ｂスプライン曲線で表し、該曲線を搬送径路とすることを含んでなる自動搬送方法。
【請求項７】
請求項４に記載の自動搬送方法であって、ラプラス方程式を用いた障害物回避のための制約条件を利用することを含んでなる自動搬送方法。
【請求項８】
請求項５に記載の自動搬送方法であって、前記折れ線の数を減少した搬送径路にコンプレックス法を適用して搬送径路を非線形最適化することを含んでなる自動搬送方法。
【請求項９】
請求項６に記載の自動搬送方法であって、前記５次Ｂスプライン曲線の搬送径路に関して逆動力学計算によるＦＦ制御を行うことを含んでなる自動搬送方法。
【請求項１０】
レーザーポインタによって搬送物の目標搬送位置の床表面にレーザー光線を照射して生成したスポット光を利用し、天井クレーンを用いて搬送物を搬送開始位置から目標搬送位置の真上までの３次元空間における搬送径路に沿って自動的に搬送するクレーンシステムであって：
搬送物を垂直方向に移動させることができ、かつ、水平面内で移動可能な台車と、該台車を水平移動自在に支持するフレームを含む天井クレーンと、
前記スポット光を撮像する少なくとも１台のカメラと；
前記少なくとも１台のカメラに接続され前記撮像したスポット光を利用してスポット光重心位置の３次元空間座標を決定するコントローラであって、前記３次元空間座標を前記目的搬送位置として前記天井クレーンの駆動装置に指令するコントローラと；
を含んでなるクレーンシステム。
【請求項１１】
請求項１０に記載のクレーンシステムであって、前記少なくとも１台のカメラはＣＣＤカメラであるクレーンシステム。
【請求項１２】
請求項１０に記載のクレーンシステムであって、前記少なくとも１台のカメラを前記天井クレーンの前記フレームに固定して設けたクレーンシステム。
【請求項１３】
請求項１０に記載のクレーンシステムであって、２台のカメラを有し、該２台のカメラと前記スポット光の間に障害物が存在しない場合、前記コントローラは、前記２台のカメラにより撮像した前記スポット光の撮像データを利用してスポット光重心位置の３次元空間座標を決定し、前記２台のカメラのうち１台のカメラのみが前記スポット光を撮像でき、他のカメラが障害物のために前記スポット光を撮像できないとき、前記１台のカメラにより撮像したスポット光の撮像データを利用してスポット光重心位置の３次元空間座標を決定するクレーンシステム。
【請求項１４】
請求項１３に記載のクレーンシステムであって、前記スポット光を撮像できるカメラが１台であるとき、前記コントローラは、前記スポット光を撮像できる該１台のカメラによる前記撮像データと、該カメラの位置の公知の座標と、光切断法により予め求めておいた前記障害物の位置情報とを利用してスポット光重心位置の３次元座標を決定するクレーンシステム。
【請求項１５】
請求項１４に記載のクレーンシステムであって、前記搬送開始位置と、前記スポット光重心位置とを結ぶ直線上に障害物が存在するとき、前記コントローラは、３次元拡散方程式に基づくポテンシャル法を適用して前記障害物の３次元障害物を回避するための折れ線状の障害物回避径路を計算し、該障害物回避径路を前記搬送径路として前記天井クレーンの駆動装置に指令するクレーンシステム。
【請求項１６】
請求項１４に記載のクレーンシステムであって、前記コントローラは、前記障害物回避径路に関して折れ線近似法を適用して前記障害物回避径路の折れ線の数を減少した搬送径路を決定し、該決定した搬送径路を前記天井クレーンの駆動装置に指令するクレーンシステム。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５】
【公開番号】特開２００８−１５２３８０（Ｐ２００８−１５２３８０Ａ）
【公開日】平成２０年７月３日（２００８．７．３）
【国際特許分類】
【出願番号】特願２００６−３３７４７４（Ｐ２００６−３３７４７４）
【出願日】平成１８年１２月１４日（２００６．１２．１４）
【出願人】（３０４０２７３４９）国立大学法人豊橋技術科学大学 (391)
【出願人】（０００１９１００９）新東工業株式会社 (474)
【Ｆターム（参考）】
【公開日】平成２０年７月３日（２００８．７．３）
【国際特許分類】
【出願日】平成１８年１２月１４日（２００６．１２．１４）
【出願人】（３０４０２７３４９）国立大学法人豊橋技術科学大学 (391)
【出願人】（０００１９１００９）新東工業株式会社 (474)
【Ｆターム（参考）】
[ Back to top ]