(57)【要約】【課題】ガイド情報を生成する範囲が広がっても計算量の増加を抑制してガイド情報を表示できる領域推定方法、計測領域表示システムおよびクレーンを提供する。【解決手段】点群データ取得工程と、計測領域ＫＡを複数のグリッドｇに分割し、これまでに代表点ｐｒが設定されていないグリッドｇ毎に、当該グリッドｇの重心位置と当該グリッドｇ内の点群データＰの平均標高値Ｈとを算出し、平均標高値Ｈにおける重心位置をグリッドｇ毎の代表点ｐｒの位置として設定するグリッド生成処理工程と、これまでに判定が行われていない複数のグリッドｇで一のグリッドｇの代表点ｐｒと隣接する他のグリッドｇの代表点ｐｒとの標高値の差が閾値以下であると判定された場合、一のグリッドｇと他のグリッドｇとが連続する領域である連続領域として設定する連続領域判定工程と、を備える。【選択図】図９
2020095342.tif 000002
【特許請求の範囲】
【請求項１】
レーザスキャナによって、計測領域にレーザを照射して点群データを取得し、前記点群データから照射点の標高値を算出する点群データ取得工程と、
前記点群データを演算処理するデータ処理手段によって、
前記計測領域を複数のグリッドに分割し、これまでに代表点が設定されていないグリッド毎に、当該グリッドの重心位置と当該グリッド内の前記点群データの平均標高値とを算出し、前記平均標高値における前記重心位置を前記グリッド毎の代表点の位置として設定するグリッド生成処理工程と、
これまでに判定が行われていない複数のグリッドで一のグリッドの代表点と隣接する他のグリッドの代表点との標高値の差が閾値以下であると判定された場合、前記一のグリッドと前記他のグリッドとが連続する領域である連続領域として設定する連続領域判定工程と、
を備え、
前記レーザスキャナがレーザを照射する範囲を移動させつつ、前記点群データ取得工程と前記グリッド生成処理工程と前記連続領域判定工程とを所定の時間毎に行う、ことを特徴とする領域推定方法。
【請求項２】
計測領域にレーザを照射して点群データを取得するレーザスキャナを備えたデータ取得部と、
取得した点群データを演算処理するデータ処理部と、
データ表示部と、を備え、
前記データ処理部は、
前記データ取得部から前記点群データを取得し、前記点群データから照射点の標高値を算出し、
前記計測領域を複数のグリッドに分割し、これまでに代表点が設定されていないグリッド毎に、当該グリッドの重心位置と当該グリッド内の前記点群データの平均標高値とを算出し、前記平均標高値における前記重心位置を前記グリッド毎の代表点の位置として設定し、
これまでに判定が行われていない複数のグリッドで一のグリッドの代表点と隣接する他のグリッドの代表点との標高値の差が閾値以下であると判定された場合、前記一のグリッドと前記他のグリッドとが連続する領域である連続領域として設定し、
前記設定された連続領域をそれぞれ区別して前記データ表示部に表示し、
前記レーザスキャナがレーザを照射する範囲を移動させつつ、前記点群データの取得から前記設定された連続領域の表示までを所定の時間毎に行う、ことを特徴とする計測領域表示システム。
【請求項３】
旋回台と、
前記旋回台に設けられるブームと、
前記ブームに取り付けられ、点群データを取得するレーザスキャナと、
取得した点群データを演算処理する制御装置と、
表示装置と、を備えるクレーンにおいて、
前記旋回台の旋回操作と、前記ブームの伸縮操作と起伏操作と、に伴って前記レーザスキャナを移動させながらレーザを照射させることで、前記レーザスキャナのレーザ照射時の位置毎の点群データを取得し、
前記制御装置は、
前記レーザスキャナのレーザ照射時の位置毎の前記点群データを取得し、前記レーザスキャナのレーザ照射時の位置とその姿勢とに基づいてレーザ照射時の位置毎の前記点群データを重ね合わせ、照射点の標高値を算出し、
前記レーザスキャナの計測領域を複数のグリッドに分割し、これまでに代表点が設定されていないグリッド毎に、当該グリッドの重心位置と当該グリッド内の前記点群データの平均標高値とを算出し、前記平均標高値における前記重心位置を前記グリッド毎の代表点の位置として設定し、
これまでに判定が行われていない複数のグリッドで一のグリッドの代表点と隣接する他のグリッドの代表点との標高値の差が閾値以下であると判定された場合、前記一のグリッドと前記他のグリッドとが連続する領域である連続領域として設定し、
前記設定された連続領域をそれぞれ区別して前記表示装置に表示し、
前記レーザスキャナがレーザを照射する範囲を移動させつつ、前記点群データの取得から前記設定された連続領域の表示までを所定の時間毎に行う、ことを特徴とするクレーン。
【請求項４】
荷物の搬送開始位置および搬送終了位置の情報を取得し、
前記荷物の搬送開始位置および搬送終了位置を含む所定の範囲で、照射点の標高値を算出する毎に、
前記荷物の搬送開始位置および搬送終了位置を含む所定の範囲におけるグリッド毎に、当該グリッドの重心位置と当該グリッド内の前記点群データの平均標高値とを算出し、前記平均標高値における前記重心位置を前記グリッド毎の代表点の位置として設定し、
前記荷物の搬送開始位置および搬送終了位置を含む所定の範囲における複数のグリッドで一のグリッドの代表点と隣接する他のグリッドの代表点との標高値の差が閾値以下であると判定された場合、前記一のグリッドと前記他のグリッドとが連続する領域である連続領域として設定する、ことを特徴とする請求項３に記載のクレーン。
【請求項５】
前記ブームの撓み、または、前記ブームの振動の検出手段を備え、
前記ブームの撓み、または、前記ブームの振動による前記レーザスキャナの位置の変動を前記検出手段によって検出し、
前記検出したレーザスキャナの位置の変動を考慮した前記レーザスキャナのレーザ照射時の位置とその姿勢とに基づいてレーザ照射時の位置毎の前記点群データを重ね合わせる、ことを特徴とする請求項３または請求項４に記載のクレーン。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、領域推定方法、計測領域表示システムおよびクレーンに関する。
【背景技術】
【０００２】
従来、モニタに表示されたガイド情報に基づいて、荷物や荷物の周辺の状態を確認し、クレーン作業の効率化を図る技術が知られている。斯かる技術は、例えば、以下の特許文献１に開示されている。
【０００３】
特許文献１には、吊荷（荷物）周辺の物体高さを通知する高さ情報通知システムに係る技術が開示されている。特許文献１記載の吊荷周辺の物体の高さ情報通知システムでは、レーザ距離センサ、マイクロ波距離センサ、ステレオカメラ等の距離計測手段によって、ブームの先端から吊荷周辺までの距離を計測する。そして、距離の計測結果を用いて吊荷周辺の物体の位置を検出するとともに高さを算出し、カメラによって撮像（撮影）された撮像画像（カメラ画像）に吊荷周辺の物体の位置および高さを対応させた処理画像（ガイド情報）を作成（生成）し、その処理画像をモニタに表示する構成としている。
【０００４】
しかしながら、特許文献１に記載された従来技術は、距離計測手段によって距離が計測される範囲における物体の位置の検出や物体の高さの算出を随時行う構成である。そのため、従来技術は、距離計測手段によって距離が計測される範囲を広くするにつれて、物体の位置の検出や物体の高さの算出に必要な計算量が大幅に増加し処理画像を表示できない可能性がある。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２０１３−１２０１７６号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
本発明の目的は、ガイド情報を生成する範囲が広がっても計算量の増加を抑制してガイド情報を表示できる領域推定方法、計測領域表示システムおよびクレーンの提供を目的とする。
【課題を解決するための手段】
【０００７】
本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段を説明する。
【０００８】
即ち、第１の発明は、レーザスキャナによって、計測領域にレーザを照射して点群データを取得し、前記点群データから照射点の標高値を算出する点群データ取得工程と、前記点群データを演算処理するデータ処理手段によって、前記計測領域を複数のグリッドに分割し、これまでに代表点が設定されていないグリッド毎に、当該グリッドの重心位置と当該グリッド内の前記点群データの平均標高値とを算出し、前記平均標高値における前記重心位置を前記グリッド毎の代表点の位置として設定するグリッド生成処理工程と、これまでに判定が行われていない複数のグリッドで一のグリッドの代表点と隣接する他のグリッドの代表点との標高値の差が閾値以下であると判定された場合、前記一のグリッドと前記他のグリッドとが連続する領域である連続領域として設定する連続領域判定工程と、を備え、前記レーザスキャナがレーザを照射する範囲を移動させつつ、前記点群データ取得工程と前記グリッド生成処理工程と前記連続領域判定工程とを所定の時間毎に行う、ことを特徴とする領域推定方法である。
【０００９】
第２の発明は、計測領域にレーザを照射して点群データを取得するレーザスキャナを備えたデータ取得部と、取得した点群データを演算処理するデータ処理部と、データ表示部と、を備え、前記データ処理部は、前記データ取得部から前記点群データを取得し、前記点群データから照射点の標高値を算出し、前記計測領域を複数のグリッドに分割し、これまでに代表点が設定されていないグリッド毎に、当該グリッドの重心位置と当該グリッド内の前記点群データの平均標高値とを算出し、前記平均標高値における前記重心位置を前記グリッド毎の代表点の位置として設定し、これまでに判定が行われていない複数のグリッドで一のグリッドの代表点と隣接する他のグリッドの代表点との標高値の差が閾値以下であると判定された場合、前記一のグリッドと前記他のグリッドとが連続する領域である連続領域として設定し、前記設定された連続領域をそれぞれ区別して前記データ表示部に表示し、前記レーザスキャナがレーザを照射する範囲を移動させつつ、前記点群データの取得から前記設定された連続領域の表示までを所定の時間毎に行う、ことを特徴とする計測領域表示システムである。
【００１０】
第３の発明は、旋回台と、前記旋回台に設けられるブームと、前記ブームに取り付けられ、点群データを取得するレーザスキャナと、取得した点群データを演算処理する制御装置と、表示装置と、を備えるクレーンにおいて、前記旋回台の旋回操作と、前記ブームの伸縮操作と起伏操作と、に伴って前記レーザスキャナを移動させながらレーザを照射させることで、前記レーザスキャナのレーザ照射時の位置毎の点群データを取得し、前記制御装置は、前記レーザスキャナのレーザ照射時の位置毎の前記点群データを取得し、前記レーザスキャナのレーザ照射時の位置とその姿勢とに基づいてレーザ照射時の位置毎の前記点群データを重ね合わせ、照射点の標高値を算出し、前記レーザスキャナの計測領域を複数のグリッドに分割し、これまでに代表点が設定されていないグリッド毎に、当該グリッドの重心位置と当該グリッド内の前記点群データの平均標高値とを算出し、前記平均標高値における前記重心位置を前記グリッド毎の代表点の位置として設定し、これまでに判定が行われていない複数のグリッドで一のグリッドの代表点と隣接する他のグリッドの代表点との標高値の差が閾値以下であると判定された場合、前記一のグリッドと前記他のグリッドとが連続する領域である連続領域として設定し、前記設定された連続領域をそれぞれ区別して前記表示装置に表示し、前記レーザスキャナがレーザを照射する範囲を移動させつつ、前記点群データの取得から前記設定された連続領域の表示までを所定の時間毎に行う、ことを特徴とするクレーンである。
【００１１】
第４の発明は、荷物の搬送開始位置および搬送終了位置の情報を取得し、前記荷物の搬送開始位置および搬送終了位置を含む所定の範囲で、照射点の標高値を算出する毎に、前記荷物の搬送開始位置および搬送終了位置を含む所定の範囲におけるグリッド毎に、当該グリッドの重心位置と当該グリッド内の前記点群データの平均標高値とを算出し、前記平均標高値における前記重心位置を前記グリッド毎の代表点の位置として設定し、前記荷物の搬送開始位置および搬送終了位置を含む所定の範囲における複数のグリッドで一のグリッドの代表点と隣接する他のグリッドの代表点との標高値の差が閾値以下であると判定された場合、前記一のグリッドと前記他のグリッドとが連続する領域である連続領域として設定する、ことを特徴とする請求項３に記載のクレーンである。
【００１２】
第５の発明は、前記ブームの撓み、または、前記ブームの振動の検出手段を備え、前記ブームの撓み、または、前記ブームの振動による前記レーザスキャナの位置の変動を前記検出手段によって検出し、前記検出したレーザスキャナの位置の変動を考慮した前記レーザスキャナのレーザ照射時の位置とその姿勢とに基づいてレーザ照射時の位置毎の前記点群データを重ね合わせる、ことを特徴とするクレーンである。
【発明の効果】
【００１３】
本発明は、以下に示すような効果を奏する。
【００１４】
第１の発明から第３の発明においては、代表点が設定されていないグリッドで、重心位置と平均標高値との算出を行い、判定が行われていないグリッドで、隣接するグリッド間の標高値の差が閾値以下か否かの判定を行うため、この算出や判定に必要な計算量が一定以下となる。これにより、ガイド情報を生成する範囲が広がっても計算量の増加を抑制してガイド情報を表示できる。
【００１５】
第４の発明においては、荷物の搬送開始位置および搬送終了位置を含む所定の範囲のグリッドで、重心位置と平均標高値との算出、および隣接するグリッド間の標高値の差が閾値以下か否かの判定が最新の点群データに基づいて行われる。これにより、荷物の搬送開始位置および搬送終了位置を含む所定の範囲について、最新の点群データに基づいて生成されたガイド情報を表示できるとともに、ガイド情報を生成する範囲が広がっても計算量の増加を抑制してガイド情報を表示できる。
【００１６】
第５の発明においては、ブームの撓みや振動が発生したときの点群データと、過去の点群データと、が適切に重ね合わせられる。これにより、ガイド情報を生成する範囲が広がっても計算量の増加を抑制してガイド情報を表示できる。
【図面の簡単な説明】
【００１７】
【図１】本発明の一実施形態に係るクレーンの全体構成を示す模式図。
【図２】本発明の一実施形態に係る計測領域表示システムとクレーンとの制御構成を示す模式図。
【図３】レーザスキャナによるレーザの照射状況の説明図、（Ａ）Ｙ軸方向視模式図、（Ｂ）Ｚ軸方向視模式図。
【図４】計測領域、個別計測領域、作業領域を説明する平面模式図。
【図５】個別計測領域とレーザにより描かれる軌跡との関係を示す模式図。
【図６】グリッド生成処理の説明図、（Ａ）点群データの分割、グリッドのスライス、平均標高値の算出の説明図、（Ｂ）代表点の設定の説明図。
【図７】三次元地図更新処理の説明図、（Ａ）前回の領域推定で出力された三次元地図の代表点と設定したグリッド毎の代表点との説明図、（Ｂ）グリッド毎に取得した代表点の説明図。
【図８】グリッドの標高値を濃淡で表した三次元地図の表示状態を示す図。
【図９】ラベリング処理の説明図、（Ａ）ラベルを付与する三次元地図を示す図、（Ｂ）ラベルの付与の説明図、（Ｃ）ラベルの付与完了時の説明図、（Ｄ）ラベルの上書き前の説明図、（Ｅ）ラベルの上書き後の説明図。
【図１０】ガイド情報の表示状態を示す図、（Ａ）カメラ画像を表示したデータ表示部を示す図、（Ｂ）カメラ画像とガイド情報を重畳表示したデータ表示部を示す図。
【図１１】連続領域毎に領域を区別して表した三次元地図の表示状態を示す図。
【図１２】データ処理部によるデータ処理の流れを示すフロー図。
【図１３】グリッド生成処理を示すフロー図。
【図１４】三次元地図更新処理を示すフロー図。
【図１５】ラベリング処理を示すフロー図。
【図１６】三次元地図更新処理の説明図、（Ａ）前回の領域推定で出力された三次元地図の代表点と設定したグリッド毎の代表点との説明図、（Ｂ）グリッド毎に取得した代表点の説明図。
【図１７】ラベリング処理の説明図、（Ａ）搬送開始位置の所定の範囲におけるラベルの付与の説明図、（Ｂ）搬送終了位置の所定の範囲におけるラベルの付与の説明図、（Ｃ）新たに計測領域となった領域におけるラベルの付与の説明図。
【図１８】グリッド生成処理を示すフロー図。
【図１９】三次元地図更新処理を示すフロー図。
【図２０】ラベリング処理を示すフロー図。
【発明を実施するための形態】
【００１８】
以下に、本発明の第一実施形態に係る計測領域表示システム５０を備えたクレーン１について説明する。尚、本実施形態においては、クレーン１として移動式クレーン（ラフテレーンクレーン）について説明を行うが、トラッククレーン等でもよい。
【００１９】
図１に示すように、クレーン１は、不特定の場所に移動可能な移動式クレーンである。クレーン１は、車両２、クレーン装置６を有する。
【００２０】
車両２は、クレーン装置６を搬送する走行車両である。車両２は、複数の車輪３を有し、エンジン４を動力源として走行する。車両２には、アウトリガ５が設けられている。アウトリガ５は、車両２の幅方向両側に油圧によって延伸可能な張り出しビームと地面に垂直な方向に延伸可能な油圧式のジャッキシリンダとから構成されている。
【００２１】
クレーン装置６は、荷物Ｗをワイヤロープによって吊り上げる作業装置である。クレーン装置６は、旋回台７、ブーム９、ジブ９ａ、メインフックブロック１０、サブフックブロック１１、起伏用油圧シリンダ１２、メインウインチ１３、メインワイヤロープ１４、サブウインチ１５、サブワイヤロープ１６、キャビン１７、制御装置１８（図２参照）等を具備する。
【００２２】
旋回台７は、クレーン装置６を旋回可能に構成する駆動装置である。旋回台７は、円環状の軸受を介して車両２のフレーム上に設けられる。旋回台７は、円環状の軸受の中心を回転中心として回転自在に構成されている。旋回台７には、アクチュエータである油圧式の旋回用油圧モータ８が設けられている。
【００２３】
旋回用油圧モータ８は、電磁比例切換弁である旋回用バルブ２３（図２参照）によって回転操作されるアクチュエータである。旋回用バルブ２３は、旋回用油圧モータ８に供給される作動油の流量を任意の流量に制御することができる。つまり、旋回台７は、旋回用バルブ２３によって回転操作される旋回用油圧モータ８を介して任意の旋回速度に制御可能に構成されている。旋回台７には、旋回台７の旋回位置（角度）と旋回速度とを検出する旋回角度検出手段である旋回用センサ２７（図２参照）が設けられている。
【００２４】
ブーム９は、荷物Ｗを吊り上げ可能な状態にワイヤロープを支持する可動支柱である。ブーム９は、複数のブーム部材から構成されている。ブーム９は、各ブーム部材をアクチュエータである図示しない伸縮用油圧シリンダで移動させることで軸方向に伸縮自在に構成されている。ブーム９は、ベースブーム部材の基端が旋回台７の略中央に揺動可能に設けられている。
【００２５】
図示しない伸縮用油圧シリンダは、電磁比例切換弁である伸縮用バルブ２４（図２参照）によって伸縮操作されるアクチュエータである。伸縮用バルブ２４は、伸縮用油圧シリンダに供給される作動油の流量を任意の流量に制御することができる。つまり、ブーム９は、伸縮用バルブ２４によって任意のブーム長さに制御可能に構成されている。ブーム９には、ブーム９の長さを検出する伸縮長さ検出手段である伸縮用センサ２８（図２参照）が設けられている。
【００２６】
メインフックブロック１０とサブフックブロック１１とは、荷物Ｗを吊る吊り具である。メインフックブロック１０には、メインワイヤロープ１４が巻き掛けられる複数のフックシーブと、荷物Ｗを吊るメインフック１０ａとが設けられている。サブフックブロック１１には、荷物Ｗを吊るサブフック１１ａが設けられている。
【００２７】
起伏用油圧シリンダ１２は、電磁比例切換弁である起伏用バルブ２５（図２参照）によって伸縮操作される。起伏用バルブ２５は、起伏用油圧シリンダ１２に供給される作動油の流量を任意の流量に制御することができる。つまり、ブーム９は、起伏用バルブ２５によって任意の起伏速度に制御可能に構成されている。ブーム９には、ブーム９の起伏角度を検出する旋回角度検出手段である起伏用センサ２９（図２参照）、荷物Ｗの重量を検出する重量センサ、ブーム９の撓みとブーム９の振動とを検出する検出手段であるモーメントセンサ３１（図２参照）等が設けられている。モーメントセンサ３１は、起伏用油圧シリンダ１２のシリンダ内の圧力を検出することでブーム９に作用するモーメントを検出する。ブーム９に作用するモーメントに基づいてブーム９の撓みとブーム９の振動とが検出される。
【００２８】
メインウインチ１３とサブウインチ１５とは、メインワイヤロープ１４とサブワイヤロープ１６との繰り入れ（巻き上げ）および繰り出し（巻き下げ）を行う巻回装置である。メインウインチ１３は、メインワイヤロープ１４が巻きつけられるメインドラムがアクチュエータである図示しないメイン用油圧モータによって回転され、サブウインチ１５は、サブワイヤロープ１６が巻きつけられるサブドラムがアクチュエータである図示しないサブ用油圧モータによって回転されるように構成されている。
【００２９】
メイン用油圧モータは、電磁比例切換弁であるメイン用バルブ２６ｍ（図２参照）によって回転操作される。メイン用バルブ２６ｍは、メイン用油圧モータに供給される作動油の流量を任意の流量に制御することができる。つまり、メインウインチ１３は、メイン用バルブ２６ｍによって任意の繰り入れおよび繰り出し速度に制御可能に構成されている。同様に、サブウインチ１５は、電磁比例切換弁であるサブ用バルブ２６ｓ（図２参照）によって任意の繰り入れおよび繰り出し速度に制御可能に構成されている。メインウインチ１３とサブウインチ１５とには、メインワイヤロープ１４とサブワイヤロープ１６との繰り出し量をそれぞれ検出する巻回用センサ３０（図２参照）が設けられている。
【００３０】
キャビン１７は、運転座席を覆うものである。運転座席には、車両２を走行操作するための操作具やクレーン装置６を操作するための旋回操作具１９、伸縮操作具２０、起伏操作具２１、メインドラム操作具２２ｍ、サブドラム操作具２２ｓ等が設けられている（図２参照）。旋回操作具１９は、旋回用油圧モータ８を操作することができる。伸縮操作具２０は、伸縮用油圧シリンダを操作することができる。起伏操作具２１は、起伏用油圧シリンダ１２を操作することができる。メインドラム操作具２２ｍは、メイン用油圧モータを操作することができる。サブドラム操作具２２ｓは、サブ用油圧モータを操作することができる。
【００３１】
このように構成されるクレーン１は、車両２を走行させることで任意の位置にクレーン装置６を移動させることができる。また、クレーン１は、起伏操作具２１の操作によって起伏用油圧シリンダ１２でブーム９を任意の起伏角度に起立させて、伸縮操作具２０の操作によってブーム９を任意のブーム長さに延伸させたりすることでクレーン装置６の揚程や作業半径を拡大することができる。また、クレーン１は、メインドラム操作具２２ｍ等によって荷物Ｗを吊り上げて、旋回操作具１９の操作によって旋回台７を旋回させることで荷物Ｗを搬送することができる。
【００３２】
図２に示すように、制御装置１８は、各バルブを介してクレーン装置６のアクチュエータを制御する。制御装置１８は、キャビン１７内に設けられている。制御装置１８は、実体的には、ＣＰＵ、ＲＯＭ、ＲＡＭ、ＨＤＤ等がバスで接続される構成であってもよく、あるいはワンチップのＬＳＩ等からなる構成であってもよい。制御装置１８は、各アクチュエータ、センサ等の動作を制御するために種々のプログラムやデータが格納されている。
【００３３】
制御装置１８は、旋回操作具１９、伸縮操作具２０、起伏操作具２１、メインドラム操作具２２ｍ、サブドラム操作具２２ｓに接続され、旋回操作具１９、伸縮操作具２０、起伏操作具２１、メインドラム操作具２２ｍ、サブドラム操作具２２ｓのそれぞれの操作量を取得することができる。
【００３４】
制御装置１８は、旋回用バルブ２３、伸縮用バルブ２４、起伏用バルブ２５、メイン用バルブ２６ｍ、サブ用バルブ２６ｓに接続され、旋回用バルブ２３、伸縮用バルブ２４、起伏用バルブ２５、メイン用バルブ２６ｍ、サブ用バルブ２６ｓに制御信号を伝達することができる。
【００３５】
制御装置１８は、旋回用センサ２７、伸縮用センサ２８、起伏用センサ２９、重量センサ、モーメントセンサ３１、巻回用センサ３０に接続され、旋回台７の旋回位置、ブーム長さ、起伏角度、荷物Ｗの重量、ブーム９に作用するモーメント、メインワイヤロープ１４とサブワイヤロープ１６との繰り出し量を取得することができる。
【００３６】
制御装置１８は、旋回台７の旋回位置、ブーム長さ、起伏角度、荷物Ｗの重量、ブーム９に作用するモーメント、メインワイヤロープ１４とサブワイヤロープ１６との繰り出し量等のクレーン１に関する情報を計測領域表示システム５０に伝達することができる。
【００３７】
尚、本説明では、ブーム９の起伏支点の軸方向を基準として、図１に示すようなＸＹＺ座標系を規定している（以下の説明においても同様）。
Ｘ軸方向（奥行方向とも呼ぶ）は、ブーム９の起伏支点の軸方向に対して垂直、かつ、水平な方向である。また、Ｙ軸方向（水平方向とも呼ぶ）は、ブーム９の起伏支点の軸方向に対して平行、かつ、水平な方向である。さらに、Ｚ軸方向は、鉛直下方向である。即ち、ＸＹＺ座標系は、ブーム９を基準としたローカル座標系として規定している（図４参照）。
【００３８】
次に、本発明の一実施形態に係る計測領域表示システム５０について、説明する。
クレーン１は、図２に示すような計測領域表示システム５０を備えている。
計測領域表示システム５０は、本発明に係る計測領域表示システム５０の一例であり、図１に示すようなクレーン１による作業を効率よく、かつ、安全に行うことを可能にするために、計測領域表示システム５０が計測対象とする領域（以下、計測領域ＫＡという（図４参照））の情報（以下、ガイド情報という）を画像で表示し、オペレータに提示するためのシステムである。
【００３９】
図２に示すように、計測領域表示システム５０は、データ取得部６０、データ処理部７０、データ表示部８０、データ入力部９０によって、構成されている。
【００４０】
データ取得部６０は、計測領域ＫＡにおけるガイド情報を生成するために必要なデータを取得する部位であり、カメラ６１、レーザスキャナ６２、慣性計測装置（ＩＭＵ）６３、第一ＧＮＳＳ受信機６４ａ、第二ＧＮＳＳ受信機６４ｂを備えている。カメラ６１、レーザスキャナ６２、慣性計測装置（ＩＭＵ）６３、第一ＧＮＳＳ受信機６４ａは、フレーム体に対して固定され、一体に構成されたセンサユニット６５となっている。
【００４１】
センサユニット６５は、クレーン１のブーム９の先端部分に付設されており、荷物Ｗの真上に位置するブーム９の先端部分から真下の状況を捉えることができる状態で配置されている（図１参照）。尚、ここでいう荷物Ｗの「真上」は、荷物Ｗの鉛直上方の位置と、その位置を基準とした一定範囲（例えば、荷物Ｗの上面の範囲）の位置と、を含む概念である。
【００４２】
センサユニット６５は、ブーム９の先端部分に対してジンバル６６（図１参照）を介して付設されており、旋回台７の旋回操作、ブーム９の起伏操作、伸縮操作が行われたときに、センサユニット６５の姿勢（Ｚ軸方向に向けた姿勢）を略一定に保持することができるように構成されている。これにより、カメラ６１とレーザスキャナ６２とを常に荷物Ｗに向けておくことができる。このため、センサユニット６５は、カメラ６１とレーザスキャナ６２とによって、荷物Ｗとその下方の地表面Ｆから、常にデータを取得することができる。また、荷物Ｗの下方の地表面Ｆに地物Ｅが存在する場合には、カメラ６１とレーザスキャナ６２とによって、地物Ｅのデータを取得することができる。
【００４３】
カメラ６１は、センサユニット６５の下方の領域（以下、個別計測領域ｋａという（図４参照））の画像を撮影するためのデジタルビデオカメラであり、撮影したカメラ画像をリアルタイムで外部に出力する機能を有している。また、カメラ６１は、適切なガイド情報の生成に必要なデータ量を考慮した画素数、画角、フレームレート、画像伝送レートを有している。
【００４４】
レーザスキャナ６２は、計測対象物にレーザを照射し、そのレーザの計測対象物における反射光を受光することによって、その反射点に係る情報を取得し、計測対象物の点群データを取得する装置である。レーザスキャナ６２は、センサユニット６５を介してブーム９の先端部分に取り付けられている。レーザスキャナ６２の計測対象物は、荷物Ｗ、地物Ｅ、地表面Ｆである。また、レーザスキャナ６２には、計測時刻を取得するための第三ＧＮＳＳ受信機６４ｃが接続されている。
そして、レーザスキャナ６２は、個別計測領域ｋａに向けて照射されるレーザにより描かれる軌跡がＹ軸方向に対して平行となるように配置されている（図３（Ｂ）参照）。また、レーザスキャナ６２は、レーザの照射角度を変更する基準軸が、Ｘ軸方向に対して平行とされている。
計測領域表示システム５０は、レーザスキャナ６２によって、リアルタイムに平面的な三次元点群データを取得する。
【００４５】
慣性計測装置（Ｉｎｅｒｔｉａｌ  Ｍｅａｓｕｒｅｍｅｎｔ  Ｕｎｉｔ、以下ＩＭＵという）６３は、データ取得時におけるカメラ６１とレーザスキャナ６２との姿勢データを取得するための装置である。ＩＭＵ６３は、リアルタイムで姿勢角を計測することが可能であり、レーザスキャナ６２によって取得した点群データの補正に利用可能な計測精度を有している。また、ＩＭＵ６３には、計測時刻を取得するための第四ＧＮＳＳ受信機６４ｄが接続されている。
【００４６】
第一ＧＮＳＳ受信機６４ａは、衛星から測距電波を受信し、座標である緯度、経度、標高値を算出するための装置である。データ処理部７０は、第一ＧＮＳＳ受信機６４ａとレーザスキャナ６２とが離間する距離が設定されており、設定された距離に基づいてリアルタイムでレーザスキャナ６２の座標を算出可能である。
【００４７】
第二ＧＮＳＳ受信機６４ｂは、衛星から測距電波を受信し、座標である緯度、経度、標高値を算出するための装置である。第二ＧＮＳＳ受信機６４ｂは、旋回台７の旋回中心位置に配置されている。第二ＧＮＳＳ受信機６４ｂは、リアルタイムで旋回台７の旋回中心の座標を算出可能である。
【００４８】
本実施形態では、第一ＧＮＳＳ受信機６４ａと第二ＧＮＳＳ受信機６４ｂとには、測定精度の高いＲＴＫ−ＧＰＳ（Ｒｅａｌ  Ｔｉｍｅ  Ｋｉｎｅｍａｔｉｃ  ＧＰＳ）測位方式を採用する。ＲＴＫ−ＧＰＳ測位方式を採用することにより、レーザスキャナ６２の位置と旋回台７の旋回中心の位置の測定精度を高めることができる。尚、ＲＴＫ−ＧＰＳ測位方式に限定されず、他の測位方法を採用してもよい。
【００４９】
第一ＧＮＳＳ受信機６４ａと第二ＧＮＳＳ受信機６４ｂとを結ぶ直線と、レーザスキャナ６２の計測軸と、ＩＭＵ６３の計測軸と、が同一直線上にあるように、第一ＧＮＳＳ受信機６４ａが配置される。また、第一ＧＮＳＳ受信機６４ａが算出するレーザスキャナ６２の座標と、第二ＧＮＳＳ受信機６４ｂが算出する旋回台７の旋回中心の座標と、によって、ブーム９を基線としたＧＮＳＳコンパスを構成し、レーザスキャナ６２の向き（方位）を算出可能である。第一ＧＮＳＳ受信機６４ａと第二ＧＮＳＳ受信機６４ｂとは、レーザスキャナ６２によって取得した点群データの補正に利用可能な計測精度を有している。
【００５０】
図３に示すように、レーザスキャナ６２は、合計１６個のレーザ送受信センサを備えており、同時に１６本のレーザを計測対象物に照射して、計測対象物の点群データを取得することができる装置である。図３（Ａ）に示すように、レーザスキャナ６２の１６個の各レーザ送受信センサは、Ｘ軸方向において２°ずつ照射角度を異ならせて配置されており、計測対象物に対して、全体で３０°の拡がりを持ってレーザを照射可能に構成されている。また、レーザスキャナ６２の各レーザ送受信センサは、Ｘ軸回りに３６０°（全方位）回転可能に構成されている。図３（Ｂ）に示すように、個別計測領域ｋａに向けて照射されるレーザにより描かれる軌跡は、Ｙ軸方向に対して平行であり、レーザスキャナ６２では、１６本の当該軌跡が同時に描かれる。
【００５１】
尚、レーザスキャナ６２は、ブーム９の最高到達高さを考慮して、その最高到達高さ（例えば、約１００ｍ）から計測対象物の三次元形状を計測可能な機器が選択される。また、レーザスキャナ６２は、適切なガイド情報を生成するために必要なデータ量およびデータ精度を考慮して、計測スピード、計測ポイント数、計測精度等の各仕様について所定の性能を有する機器が選択される。
【００５２】
尚、本実施形態では、合計１６個のレーザ送受信センサを備えたレーザスキャナ６２を用いる場合を例示しているが、本発明に係る計測領域表示システム５０は、レーザスキャナ６２を構成するレーザ送受信センサの個数によっては限定されない。即ち、本発明に係る計測領域表示システム５０では、クレーン１のブーム９（ジブ９ａ）の最高到達高さ等に応じて、最適な仕様のレーザスキャナ６２が適宜選択される。
【００５３】
センサユニット６５によって個別計測領域ｋａにおいて取得するデータには、荷物Ｗ、荷物Ｗの下方の地表面Ｆ、荷物Ｗの下方の地表面Ｆに存在する地物Ｅをカメラ６１によって撮影した画像データが含まれる。また、センサユニット６５によって個別計測領域ｋａにおいて取得するデータには、荷物Ｗ、地表面Ｆ、地物Ｅをレーザスキャナ６２によってスキャンして取得した点群データが含まれる。尚、ここでいう地表面Ｆには、荷物Ｗの搬送元および搬送先となる面を広く含み、地上面のみならず、建物屋上の床面や屋根面等も含まれる。
【００５４】
データ処理手段であるデータ処理部７０は、データ取得部６０で取得したデータを演算処理して、オペレータに提示するガイド情報を生成するための部位であり、本実施形態では、所定のデータ処理プログラムがインストールされた汎用のパーソナルコンピュータによって構成している。
また、データ処理部７０は、クレーン１の制御装置１８と電気的に接続されており、制御装置１８から出力される旋回台７の旋回位置、ブーム長さ、起伏角度、荷物Ｗの重量、メインワイヤロープ１４とサブワイヤロープ１６との繰り出し量等のクレーン１に関する情報が入力される。
【００５５】
データ表示部８０は、オペレータに提示するガイド情報を表示するための部位であり、データ処理部７０に接続された表示装置により構成される。
データ表示部８０は、計測領域ＫＡの三次元地図と個別計測領域ｋａのカメラ画像とをリアルタイムに表示する。
【００５６】
ここで、計測領域ＫＡとガイド情報とについて説明する。
【００５７】
計測領域ＫＡとは、ガイド情報を生成する対象となる領域である。
図４に示すように、計測領域表示システム５０は、センサユニット６５の下方の個別計測領域ｋａに存在する荷物Ｗ、地表面Ｆ、地物Ｅを計測する。センサユニット６５は、旋回台７の旋回操作、起伏操作、ブーム９の伸縮操作に応じて移動する。このため、個別計測領域ｋａも、センサユニット６５の移動に応じて移動する。計測領域ＫＡは、異なる位置から計測された個別計測領域ｋａを併せた領域である。計測領域ＫＡは、計測領域表示システム５０が計測可能な領域の全体を計測した場合、ブーム９の先端部分が稼動可能な領域である作業領域ＳＡを含む領域となる。
【００５８】
ここでいうガイド情報は、オペレータがクレーン１によって荷物Ｗを搬送するときに、ブーム９の長さ・旋回位置・起伏角度、メインワイヤロープ１４とサブワイヤロープ１６との繰り出し量等の良否について、オペレータの判断を補助する情報である。ガイド情報には、計測領域ＫＡの三次元地図、カメラ画像情報、荷物Ｗと地物Ｅとの形状に係る情報、荷物Ｗの高さ情報、地物Ｅの高さ情報、荷物Ｗの動線に係る情報等が含まれる。
【００５９】
図２に示すように、データ入力部９０は、データ処理部７０に対して、設定値等を入力するための部位であり、タッチパネル、マウス、キーボード装置等の入力装置により構成される。
【００６０】
図１に示すように、データ表示部８０とデータ入力部９０は、キャビン１７内の運転座席の前方のオペレータが見やすい位置に配置する。データ処理部７０は、センサユニット６５の近傍に配置することが好ましい。尚、計測領域表示システム５０は、データ処理部７０、データ表示部８０、データ入力部９０をタブレットＰＣによって一体的に構成した場合には、データ処理部７０をキャビン１７内に配置する構成としてもよい。
データ取得部６０とデータ処理部７０間のデータの伝送は、有線ＬＡＮによることが好ましい。尚、データ取得部６０とデータ処理部７０間のデータの伝送は、無線ＬＡＮを採用してもよく、あるいは、電力線通信を採用してもよい。
【００６１】
ここで、データ取得部６０によるデータの取得状況を説明する。
データ取得部６０は、カメラ６１によって、個別計測領域ｋａを連続的に撮影し、個別計測領域ｋａのカメラ画像を取得する。
【００６２】
図５に示すように、データ取得部６０は、レーザスキャナ６２によって、個別計測領域ｋａを連続的にスキャンし、個別計測領域ｋａにおける計測対象物の点群データを取得する。以下では、レーザスキャナ６２によって取得する点群データを、点群データＰと呼ぶ。点群データＰは、点データｐの集合であり、点データｐは、個別計測領域ｋａに存在する地表面Ｆ、荷物Ｗ、地物Ｅに位置する点を表している。
【００６３】
データ取得部６０は、レーザスキャナ６２によって点群データＰを取得すると同時に、第三ＧＮＳＳ受信機６４ｃによって複数の測位衛星から時間情報を受信する。そして、データ処理部７０は、点データｐに対して、該点データｐの取得時間ｔｐに係る情報を付与する。
【００６４】
また、データ取得部６０は、レーザスキャナ６２によって、点群データＰを取得すると同時に、ＩＭＵ６３によって所定の周期でレーザスキャナ６２の姿勢データＱを取得し、第一ＧＮＳＳ受信機６４ａと第二ＧＮＳＳ受信機６４ｂとによってレーザスキャナ６２の位置データＲと方位データＫとを取得する。尚、データ処理部７０は、第二ＧＮＳＳ受信機６４ｂによって取得される旋回台７の旋回中心の位置と、制御装置１８から出力される旋回台７の旋回位置、ブーム長さ、起伏角度に基づいて、レーザスキャナ６２の位置と向きとを算出してもよい。
【００６５】
姿勢データＱには、レーザスキャナ６２のＸ・Ｙ・Ｚ軸の各軸方向に対する角度と加速度に係る情報が含まれる。尚、ＩＭＵ６３による姿勢データＱの取得周期は、レーザスキャナ６２による点群データＰの取得周期よりも短くする。姿勢データＱは、計測周期ごとに計測される個別姿勢データｑの集合である。
【００６６】
データ取得部６０は、ＩＭＵ６３によって姿勢データＱを取得すると同時に、第四ＧＮＳＳ受信機６４ｄによって、複数の測位衛星から時間情報を受信する。データ処理部７０は、個別姿勢データｑに対して、該個別姿勢データｑの取得時間に係る情報として取得時間ｔｑを付与する。
【００６７】
位置データＲには、レーザスキャナ６２のＸＹＺ座標系における位置に係る情報が含まれる。尚、第一ＧＮＳＳ受信機６４ａと第二ＧＮＳＳ受信機６４ｂとによる位置データＲの取得周期は、レーザスキャナ６２による点群データＰの取得周期よりも短くする。位置データＲは、計測周期ごとに計測される個別位置データｒの集合である。データ処理部７０は、個別位置データｒに基づいて個別方位データｋを算出する。方位データＫは、計測周期ごとに計測される個別方位データｋの集合である。
【００６８】
第一ＧＮＳＳ受信機６４ａと第二ＧＮＳＳ受信機６４ｂとは、位置データＲと方位データＫとを取得すると同時に、複数の測位衛星から時間情報を受信する。データ処理部７０は、位置データＲと方位データＫとに対して、該位置データＲと該方位データＫとの取得時間に係る情報として取得時間ｔｒを付与する。
【００６９】
次に、データ処理部７０によるデータの処理状況を説明する。
【００７０】
本発明の一実施形態に係る領域推定方法は、点群データ取得工程、グリッド生成処理工程、連続領域判定工程を備える（図１２参照）。点群データ取得工程は、時刻対応処理（ＳＴＥＰ−１０１）と剛体変換処理（ＳＴＥＰ−１０２）とを備える。グリッド生成処理工程は、グリッド生成処理Ａ（ＳＴＥＰ−１０３）と三次元地図更新処理Ｂ（ＳＴＥＰ−１０４）とを備える。連続領域判定工程は、ラベリング処理Ｃ（ＳＴＥＰ−１０５）を備える。データ処理部７０は、領域を推定する処理として、時刻対応処理（ＳＴＥＰ−１０１）から三次元地図可視化処理（ＳＴＥＰ−１０８）までの一連の処理を所定の時間毎に行う。以下では、所定の時間毎に行われる一連の処理について、一連の処理が行われる１回目を「１回目の領域推定」とする。１回目の領域推定の後、所定の時間毎に行われる一連の処理を「２回目の領域推定」、「３回目の領域推定」、・・・とする。旋回台７の旋回操作、起伏操作、ブーム９の伸縮操作によってレーザスキャナ６２が移動して、新たに計測領域ＫＡとなる領域があるものとして説明する。
【００７１】
（点群データ取得工程）
データ処理部７０は、計測データを取得する。具体的には、データ処理部７０は、点群データＰのストリームデータから、１フレーム分の点群データＰを切り出して出力する。１フレーム分の点群データＰは、レーザスキャナ６２によるレーザの照射方向がＸ軸回りに１周する間に取得する点データｐの集合である。また、データ処理部７０は、カメラ６１のカメラ画像、ＩＭＵ６３の姿勢データＱ、第一ＧＮＳＳ受信機６４ａと第二ＧＮＳＳ受信機６４ｂとによって取得する位置データＲおよび方位データＫを計測データとして取得する。
【００７２】
データ処理部７０は、１フレーム分の点群データＰに含まれる点データｐを、ＩＭＵ６３によって取得した姿勢データＱと、第一ＧＮＳＳ受信機６４ａと第二ＧＮＳＳ受信機６４ｂとによって取得した位置データＲおよび方位データＫと、時間によって対応付ける（図１２の時刻対応処理（ＳＴＥＰ−１０１）参照）。
具体的には、データ処理部７０は、姿勢データＱについて、個々の点データｐにおいて、その点データｐの取得時間ｔｐに最も近い個別姿勢データｑの取得時間ｔｑを探索し、該取得時間ｔｑにおける個別姿勢データｑを、その点データｐに対応付ける。また、データ処理部７０は、位置データＲおよび方位データＫについて、個々の点データｐにおいて、その点データｐの取得時間ｔｐに最も近い位置データＲおよび方位データＫの取得時間ｔｒを探索し、該取得時間ｔｒにおける個別位置データｒおよび個別方位データｋを、その点データｐに対応付ける。
【００７３】
このようにしてデータ処理部７０は、個別姿勢データｑ、個別位置データｒ、個別方位データｋとが時間によって対応付けられた点データｐを出力する。
【００７４】
データ処理部７０は、時間によって対応付けられた点データｐ、個別姿勢データｑ、個別位置データｒ、個別方位データｋの組み合わせに対して剛体変換処理を行う（図１２の剛体変換処理（ＳＴＥＰ−１０２）参照）。具体的には、データ処理部７０は、個別姿勢データｑ、個別位置データｒ、個別方位データｋとに基づいて点群データＰのアフィン変換を行って、点群データＰを平面直角座標系に変換する。これにより、傾き、位置、向きが補正された点群データＰが出力される。点データｐの標高値は、傾き、位置、向きが補正された点データｐのＺ座標の値となる。つまり、レーザスキャナ６２の照射点の標高値は、点データｐのＺ座標の値として算出されている。但し、Ｚ軸は、鉛直下方向の軸であるため、Ｚ座標の値が大きくなるに応じて、標高が低い位置となる。
【００７５】
（グリッド生成処理工程）
図６に示すように、データ処理部７０は、補正された点群データＰを一定の大きさのグリッドｇで分割し、グリッドｇの代表点ｐｒを設定する（図１２のグリッド生成処理Ａ（ＳＴＥＰ−１０３））。具体的には、まず、データ処理部７０は、補正された点群データＰを重ね合わせる。図６（Ａ）に示すように、次に、データ処理部７０は、重ね合わせた点群データＰを一定の大きさのグリッドｇで分割する。そして、データ処理部７０は、点データｐが所定の数以上存在するグリッドｇにより構成される領域であるとともに、前回の領域推定で出力された三次元地図において代表点ｐｒが存在しない領域（図７（Ａ）左図参照）を、新たに計測領域ＫＡとなった領域として認識する。所定の数は、任意に設定されている。前回の領域推定で出力された三次元地図において代表点ｐｒが存在しない領域は、これまでに代表点ｐｒが設定されていないグリッドｇで構成される領域である。尚、１回目の領域推定の場合は、点データｐが所定の数以上存在するグリッドｇにより構成される領域の全てが新たに計測領域ＫＡとなった領域として認識される。
【００７６】
重ね合わせた点群データＰには、地物Ｅや地表面Ｆの上面だけではなく、地物Ｅや地表面Ｆの側面にレーザが照射され取得された点データｐが含まれる可能性がある。地物Ｅや地表面Ｆの上面を対象としてガイド情報を生成するため、まず、データ処理部７０は、新たに計測領域ＫＡとなった領域のグリッドｇ毎に、グリッドｇを任意の間隔で水平の方向にスライスする。そして、データ処理部７０は、新たに計測領域ＫＡとなった領域のグリッドｇ毎に、スライスされて形成される層Ｌ１・Ｌ２・Ｌ３・・・のうち、点データｐが存在し、かつ、最も標高が高い位置にある層Ｌ１の点データｐ（点群データＰ）の標高値の平均値である平均標高値Ｈを算出する。また、データ処理部７０は、新たに計測領域ＫＡとなった領域のグリッドｇ毎に、グリッドｇの重心位置を算出する。図６（Ｂ）に示すように、最後に、データ処理部７０は、新たに計測領域ＫＡとなった領域のグリッドｇ毎に、算出した平均標高値Ｈにおけるグリッドｇの重心位置をグリッドｇの代表点ｐｒの位置として設定する。これにより、データ処理部７０は、地表面Ｆに凹凸があり、地表面Ｆの凹凸の側面にレーザが照射された場合でも、地表面Ｆの凹凸の上面にレーザが照射され取得されたと推定される点群データＰの代表点ｐｒを設定できる。
【００７７】
尚、平均標高値Ｈを算出する層は、層Ｌ１に限定されず、各層における、点データｐの数、点データｐの位置、点データｐの密度に基づいて選択される層であってもよい。例えば、各層のうち、点データｐの数が最も多い層が選択されてもよい。或いは、任意の数以上の点データｐが存在する層のうち、最も高い層が選択されてもよい。或いは、Ｚ方向視で均等に点データｐが存在する層は、地物Ｅの上面に照射された点データｐである可能性が高いため、Ｚ方向視で均等に点データｐが存在する層が選択されてもよい。
【００７８】
図７に示すように、データ処理部７０は、設定したグリッドｇ毎の代表点ｐｒを用いて三次元地図を更新する（図１２の三次元地図更新処理Ｂ（ＳＴＥＰ−１０４））。
【００７９】
データ処理部７０は、前回の領域推定で出力された三次元地図の代表点ｐｒと設定したグリッドｇ毎の代表点ｐｒとを用いて三次元地図を更新する。図７（Ａ）左図は、前回の領域推定で出力された三次元地図の代表点ｐｒを代表点ｐｒ１として、グリッドｇに代表点ｐｒ１のみを示した図である。図７（Ａ）右図は、設定したグリッドｇ毎の代表点ｐｒを代表点ｐｒ２として、グリッドｇに代表点ｐｒ２のみを示した図である。図７（Ｂ）に示すように、具体的には、まず、データ処理部７０は、代表点ｐｒ１と代表点ｐｒ２とをグリッドｇ毎に取得する。そして、データ処理部７０は、全ての代表点ｐｒ毎にグリッドｇの大きさの面を生成し、計測領域ＫＡの三次元地図として出力する。図８に示すように、三次元地図Ｍをデータ表示部８０に表示した場合、グリッドｇの代表点ｐｒの標高値が高くなるに応じて面Ｓの色が濃く表示される。尚、１回目の領域推定の場合は、代表点ｐｒ２毎にグリッドｇの大きさの面を生成し、計測領域ＫＡの三次元地図として出力する。
【００８０】
（連続領域判定工程）
図９に示すように、データ処理部７０は、三次元地図を用いて連続領域毎にラベルを付与する（図１２のラベリング処理Ｃ（ＳＴＥＰ−１０５）参照）。連続領域とは、隣接するグリッドｇの代表点ｐｒの標高値の差が閾値以下となる領域である。閾値は、レーザスキャナ６２のＺ軸方向の計測誤差に基づいて設定されており、例えば、０．１ｍとしている。ラベルは、１番から順番に番号で付与される。以下では、説明のため、グリッドｇの代表点ｐｒの標高値は、標高が最も低い位置に存在する代表点ｐｒの標高値を基準として、基準とした代表点ｐｒからの高さとしている。
【００８１】
図９（Ａ）（Ｂ）に示すように、次に、データ処理部７０は、ラベルを付与する三次元地図から注目グリッドｇａを選択する。注目グリッドｇａの代表点ｐｒの標高値と、その左上、上、右上、左の４近傍（以下、単に４近傍という）にある各グリッドｇの代表点ｐｒの標高値と、の比較が行われる。注目グリッドｇａが選択される順番は、新たに計測領域ＫＡとなった領域の中から、左上を起点に左端から右に、右端に到達すると一つ下の段の左端から右に選択される。データ処理部７０は、前回以前の領域推定でラベルが付与されている領域について、前回以前の領域推定で付与されたラベルを用いる。
【００８２】
データ処理部７０は、注目グリッドｇａの代表点ｐｒの標高値とその４近傍にある各グリッドｇの代表点ｐｒの標高値との差のいずれかが閾値以下の場合は、標高値の差が閾値以下であるグリッドｇと同一のラベルを注目グリッドｇａに付与し、注目グリッドｇａの代表点ｐｒの標高値とその４近傍にある各グリッドｇの代表点ｐｒの標高値との差が全て閾値よりも大きい場合は、新たなラベルを付与する。但し、データ処理部７０は、注目グリッドｇａの代表点ｐｒの標高値とその４近傍にある各グリッドｇの代表点ｐｒの標高値との差が閾値以下であるグリッドｇのラベルの種類が複数の場合は、標高値の差が閾値以下であるグリッドｇのラベルのうち、最も番号が小さいラベルを付与する。これらの処理を全てのグリッドｇに対して行うことで、注目グリッドｇａとその左上、上、右上、左、右、左下、下、右下の８近傍にあるグリッドｇとの比較ができる。
【００８３】
例えば、データ処理部７０は、図９（Ｂ）に示す注目グリッドｇａが選択されている場合、注目グリッドｇａの代表点ｐｒの標高値とその４近傍にある各グリッドｇの代表点ｐｒの標高値との差を、全て０．６ｍと算出する。データ処理部７０は、注目グリッドｇａの代表点ｐｒの標高値とその４近傍にある各グリッドｇの代表点ｐｒの標高値との差が全て閾値０．１ｍよりも大きいため、６番のラベルの番号を１だけ増加させた７番のラベルを注目グリッドｇａに付与している。
【００８４】
図９（Ｃ）（Ｄ）（Ｅ）に示すように、データ処理部７０は、全てのグリッドｇにラベルが付与された後に、グリッドｇから注目グリッドｇａを再び選択する。注目グリッドｇａが選択される順番は、ラベルを付与する際と同様に、新たに計測領域ＫＡとなった領域の中から、左上を起点に左端から右に、右端に到達すると一つ下の段の左端から右に選択される。
【００８５】
データ処理部７０は、注目グリッドｇａの代表点ｐｒの標高値とその４近傍にある各グリッドｇの代表点ｐｒの標高値とを比較する。データ処理部７０は、注目グリッドｇａの４近傍のグリッドｇに、標高値の差が閾値以下で、かつ、注目グリッドｇａと異なるラベルが付与されている場合は、標高値の差が閾値以下で、かつ、注目グリッドｇａと異なるラベルが付与されているグリッドｇのラベルを注目グリッドｇａのラベルで上書きする。
【００８６】
例えば、データ処理部７０は、図９（Ｄ）に示す注目グリッドｇａが選択されている場合、その左と右上にある各グリッドｇの代表点ｐｒとの標高値の差を、それぞれ０ｍと算出し、その左上と上にある各グリッドｇの代表点ｐｒとの標高値の差を、それぞれ１．５ｍと算出する。さらに、注目グリッドｇａの左にあるグリッドｇは、９番のラベルが付与されており、注目グリッドｇａに付与されている８番のラベルと異なる。従って、注目グリッドｇａの左にあるグリッドｇは、標高値の差が閾値０．１ｍ以下で、かつ、注目グリッドｇａと異なるラベルが付与されている。図９（Ｅ）に示すように、このため、データ処理部７０は、注目グリッドｇａの左にあるグリッドｇのラベルを８番のラベルで上書きしている。
【００８７】
最後に、データ処理部７０は、連続領域毎にラベルが付与されている三次元地図を出力する。このように、データ処理部７０は、これまでに判定が行われていないグリッドｇにおいて、同一のラベルが付与されたグリッドｇを連続領域として設定している。尚、出力される三次元地図は、情報として記憶されており、次回の領域推定で用いることができる。
【００８８】
本実施形態において、計測領域表示システム５０がクレーン１から独立した構成として説明したが、データ取得部６０が備える各種センサ６１〜６４ｄ、データ表示部８０が備える表示装置、データ入力部９０が備える入力装置をクレーン１が具備し、データ処理部７０が行うデータ処理を制御装置１８が行う構成であってもよい。
【００８９】
このような領域推定方法を実施する計測領域表示システム５０およびクレーン１は、代表点ｐｒが設定されていないグリッドｇで、重心位置と平均標高値Ｈとの算出を行い、判定が行われていないグリッドｇで、隣接するグリッドｇ間の標高値の差が閾値以下か否かの判定を行うため、この算出や判定に必要な計算量が一定以下となる。これにより、ガイド情報を生成する範囲が広がっても計算量の増加を抑制してガイド情報を表示できる。また、計算量の増加を抑制することによって、データ処理部７０の小型化、省力化が可能となる。
【００９０】
データ処理部７０は、ラベルが付与された三次元地図の中から、地表面Ｆ、荷物Ｗとそれら以外の領域を示すラベルを推定する（図１２の同一領域推定処理（ＳＴＥＰ−１０６））。具体的には、データ処理部７０は、地表面Ｆの領域が最も広いと考えられるため、グリッドｇの数が最も多い同一のラベルを地表面Ｆのグリッドｇに付与されたラベルとする。つまり、データ処理部７０は、連続領域のうち、最もグリッドｇの数が多い連続領域を地表面Ｆと推定する。データ処理部７０は、このような地表面Ｆの推定をリアルタイムで自動的に行うことができる。図９（Ｅ）に示すように、例えば、データ処理部７０は、１番のラベルのグリッドｇが最も多いため、１番のラベルの連続領域を地表面Ｆと推定する（白抜き部分参照）。データ処理部７０は、三次元地図Ｍをデータ表示部８０に表示した場合、地表面Ｆの領域を他の領域と色や濃淡を区別して表示する（図１１参照）。
【００９１】
また、データ処理部７０は、手動で入力された荷物Ｗの範囲（図１０（Ｂ）参照）にあるグリッドｇの代表点ｐｒの中で最も標高値の低い代表点ｐｒのグリッドｇのラベルを取得し、荷物Ｗのグリッドｇに付与されたラベルとする。これは、グリッドｇの中に荷物Ｗのグリッドｇとフックやワイヤのグリッドｇが含まれる場合、フックやワイヤロープのグリッドｇにおける代表点ｐｒの標高値よりも荷物Ｗのグリッドｇにおける代表点ｐｒの標高値の方が低いためである。尚、荷物Ｗの高さ（Ｚ軸方向の長さ）は、ブーム９の先端部分からでは荷物Ｗの側面や下部を計測できないため、実測されてデータ処理部７０に入力されている。
【００９２】
データ処理部７０はグリッドｇの代表点ｐｒの集合を用いて、荷物Ｗ、地物Ｅ毎に大きさと高さをカメラ画像上に可視化する（図１２の領域可視化処理（ＳＴＥＰ−１０７））。具体的には、まず、データ処理部７０は、第一ＧＮＳＳ受信機６４ａと第二ＧＮＳＳ受信機６４ｂとの計測データから現在時刻のレーザスキャナ６２の位置と向き（方位）とを算出する。次に、データ処理部７０は、算出したレーザスキャナ６２の位置と向きとに基づいて座標軸を決定し、荷物Ｗや地物Ｅ等の代表点ｐｒのカメラ画像上における位置を合わせて表示する。
【００９３】
図１０に示すように、データ処理部７０は、荷物Ｗや地物Ｅ等の代表点ｐｒのカメラ画像Ｉ上における位置を用いて、荷物Ｗや地物Ｅをカメラ画像Ｉ上で内包する外形線を算出し、外形線が成す外形図形をガイド情報ＧＤ１としてカメラ画像Ｉ上に表示する。最後に、データ処理部７０は、ガイド情報ＧＤ１の上に荷物Ｗや地物Ｅの標高値と地表面Ｆの標高値の差分値をガイド情報ＧＤ２（高さの情報）として表示する。尚、ガイド情報ＧＤ１の描画色は、荷物Ｗや地物Ｅの高さに応じて濃淡を変更した所定の色で表示する。また、荷物Ｗや地物Ｅの高さの有効桁数は、小数第一位とする。
【００９４】
図１１に示すように、データ処理部７０は、荷物Ｗ、地表面Ｆ、地物Ｅ毎にラベルが付与された計測領域ＫＡの三次元地図を用いて、それぞれの三次元空間における位置関係と大きさを可視化する（図１２の三次元地図可視化処理（ＳＴＥＰ−１０８））。具体的には、まず、データ処理部７０は、荷物Ｗ、地表面Ｆ、地物Ｅ毎の代表点ｐｒの位置と標高値とに基づいて、代表点ｐｒを重心とする面Ｓを生成する。このとき、面Ｓの幅は代表点ｐｒの生成時に用いたグリッドｇの幅とする。そして、データ処理部７０は、荷物Ｗ、地表面Ｆ、地物Ｅ毎に面Ｓに色付けを行い、三次元空間における三次元地図Ｍとしてデータ表示部８０に可視化する。
【００９５】
以下に、計測領域表示システム５０の制御態様について具体的に説明する。
【００９６】
図１２に示すように、データ処理部７０は、計測データが入力され、ＳＴＥＰ−１０１に移行する。
【００９７】
データ処理部７０は、ＳＴＥＰ−１０１において、時刻対応処理を行い、ＳＴＥＰ−１０２に移行する。
【００９８】
データ処理部７０は、ＳＴＥＰ−１０２において、剛体変換処理を行い、ＳＴＥＰ−１０３に移行する。
【００９９】
データ処理部７０は、ＳＴＥＰ−１０３において、グリッド生成処理Ａを開始し、ＳＴＥＰ−２０１に移行する（図１３参照）。そして、グリッド生成処理Ａが終了するとＳＴＥＰ−１０４に移行する。
【０１００】
データ処理部７０は、ＳＴＥＰ−１０４において、三次元地図更新処理Ｂを開始し、ＳＴＥＰ−３０１に移行する（図１４参照）。そして、三次元地図更新処理Ｂが終了するとＳＴＥＰ−１０５に移行する。
【０１０１】
データ処理部７０は、ＳＴＥＰ−１０５において、ラベリング処理Ｃを開始し、ＳＴＥＰ−４０１に移行する（図１５参照）。そして、ラベリング処理Ｃが終了するとＳＴＥＰ−１０６に移行する。
【０１０２】
データ処理部７０は、ＳＴＥＰ−１０６において、同一領域推定処理を行い、ＳＴＥＰ−１０７に移行する。
【０１０３】
データ処理部７０は、ＳＴＥＰ−１０７において、領域可視化処理を行い、ＳＴＥＰ−１０８に移行する。
【０１０４】
データ処理部７０は、ＳＴＥＰ−１０８において、三次元地図可視化処理を行い、可視化結果を出力する。可視化結果とは、三次元地図Ｍやカメラ画像情報等である。
【０１０５】
図１３に示すように、データ処理部７０は、ＳＴＥＰ−２０１において、グリッド生成処理Ａを開始し、補正された点群データＰを重ね合わせて、ＳＴＥＰ−２０２に移行する。
【０１０６】
データ処理部７０は、ＳＴＥＰ−２０２において、重ね合わせた点群データＰを一定の大きさのグリッドｇで分割し、ＳＴＥＰ−２０３に移行する。
【０１０７】
データ処理部７０は、ＳＴＥＰ−２０３において、点データｐが所定の数以上存在するグリッドｇにより構成される領域であるとともに、前回の領域推定で出力された三次元地図において代表点ｐｒが存在しない領域を、新たに計測領域ＫＡとなった領域として認識し、ＳＴＥＰ−２０４に移行する。
【０１０８】
データ処理部７０は、ＳＴＥＰ−２０４において、新たに計測領域ＫＡとなった領域を代表点ｐｒが設定される領域と定めて、ＳＴＥＰ−２０５に移行する。
【０１０９】
データ処理部７０は、ＳＴＥＰ−２０５において、グリッドｇを任意の間隔で水平の方向にスライスし、複数の層Ｌ１・Ｌ２・Ｌ３・・・を形成し、ＳＴＥＰ−２０６に移行する。
【０１１０】
データ処理部７０は、ＳＴＥＰ−２０６において、各層のうち、点データｐが存在し、かつ、最も標高が高い位置にある層Ｌ１の点データｐの平均標高値Ｈを算出し、ＳＴＥＰ−２０７に移行する。
【０１１１】
データ処理部７０は、ＳＴＥＰ−２０７において、グリッドｇの重心位置を算出し、ＳＴＥＰ−２０８に移行する。
【０１１２】
データ処理部７０は、ＳＴＥＰ−２０８において、算出した平均標高値Ｈにおけるグリッドｇの重心位置をグリッドｇの代表点ｐｒの位置として設定し、ＳＴＥＰ−２０９に移行する。
【０１１３】
データ処理部７０は、ＳＴＥＰ−２０９において、新たに計測領域ＫＡとなった領域の全てのグリッドｇで代表点ｐｒの設定が完了したか否かを判定する。
その結果、データ処理部７０は、新たに計測領域ＫＡとなった領域の全てのグリッドｇで代表点ｐｒの設定が完了した場合、グリッド生成処理Ａを終了し、ＳＴＥＰ−１０４に移行する。
一方、データ処理部７０は、新たに計測領域ＫＡとなった領域の全てのグリッドｇで代表点ｐｒの設定が完了していない場合、ＳＴＥＰ−２０５に移行して、代表点ｐｒの設定が行われていないグリッドｇに対してＳＴＥＰ−２０５を行う。
【０１１４】
図１４に示すように、データ処理部７０は、ＳＴＥＰ−３０１において、前回の領域推定で出力された三次元地図の代表点ｐｒ１と設定された代表点ｐｒ２を取得し、ＳＴＥＰ−３０２に移行する。
【０１１５】
データ処理部７０は、ＳＴＥＰ−３０２において、取得したグリッドｇの代表点ｐｒ（代表点ｐｒ１と代表点ｐｒ２）毎にグリッドｇの大きさの面を生成し、計測領域ＫＡの三次元地図として出力して、三次元地図更新処理Ｂを終了し、ＳＴＥＰ−１０５に移行する。
【０１１６】
図１５に示すように、データ処理部７０は、ＳＴＥＰ−４０１において、新たに計測領域ＫＡとなった領域を注目グリッドｇａが選択される領域と定めて、ＳＴＥＰ−４０２に移行する。
【０１１７】
データ処理部７０は、ＳＴＥＰ−４０２において、注目グリッドｇａの代表点ｐｒの標高値とその４近傍にある各グリッドｇの代表点ｐｒの標高値との差を算出し、ＳＴＥＰ−４０３に移行する。
【０１１８】
データ処理部７０は、ＳＴＥＰ−４０３において、算出した標高値の差のいずれかが閾値以下か否かを判定する。尚、データ処理部７０は、４近傍のグリッドｇがない（注目グリッドｇａが三次元地図の左上にある）場合は、ＳＴＥＰ−４０５に移行して注目グリッドｇａに１番のラベルを付与する。
その結果、データ処理部７０は、算出した標高値の差のいずれかが閾値以下である場合、ＳＴＥＰ−４０４に移行する。
一方、データ処理部７０は、算出した標高値の差が全て閾値よりも大きい場合、ＳＴＥＰ−４０５に移行する。
【０１１９】
データ処理部７０は、ＳＴＥＰ−４０４において、標高値の差が閾値以下のグリッドｇの中で最も番号が小さいラベルを注目グリッドｇａに付与し、ＳＴＥＰ−４０６に移行する。
【０１２０】
データ処理部７０は、ＳＴＥＰ−４０５において、注目グリッドｇａに新たなラベルを付与し、ＳＴＥＰ−４０６に移行する。
【０１２１】
データ処理部７０は、ＳＴＥＰ−４０６において、新たに計測領域ＫＡとなった領域の全てのグリッドｇに対してラベルの付与が完了したか否かを判定する。
その結果、データ処理部７０は、新たに計測領域ＫＡとなった領域の全てのグリッドｇに対してラベルの付与が完了した場合、ＳＴＥＰ−４０７に移行する。
一方、データ処理部７０は、新たに計測領域ＫＡとなった領域の全てのグリッドｇに対してラベルの付与が完了していない場合、ＳＴＥＰ−４０２に移行し、注目グリッドｇａの右隣または次の行のグリッドｇを次の注目グリッドｇａとしてＳＴＥＰ−４０２を行う。
【０１２２】
データ処理部７０は、ＳＴＥＰ−４０７において、注目グリッドｇａの代表点ｐｒの標高値とその４近傍にある各グリッドｇの代表点ｐｒの標高値との差を算出し、ＳＴＥＰ−４０８に移行する。
【０１２３】
データ処理部７０は、ＳＴＥＰ−４０８において、注目グリッドｇａの４近傍のグリッドｇに、標高値の差が閾値以下で、かつ、注目グリッドｇａと異なるラベルが付与されているか否かを判定する。
その結果、データ処理部７０は、注目グリッドｇａの４近傍のグリッドｇに、標高値の差が閾値以下で、かつ、注目グリッドｇａと異なるラベルが付与されている場合、ＳＴＥＰ−４０９に移行する。
一方、データ処理部７０は、注目グリッドｇａの４近傍のグリッドｇに、標高値の差が閾値以下で、かつ、注目グリッドｇａと異なるラベルが付与されていない場合、ＳＴＥＰ−４１０に移行する。
【０１２４】
データ処理部７０は、ＳＴＥＰ−４０９において、標高値の差が閾値以下で、かつ、注目グリッドｇａと異なるラベルが付与されているグリッドｇのラベルを注目グリッドｇａのラベルで上書きし、ＳＴＥＰ−４１０に移行する。
【０１２５】
データ処理部７０は、ＳＴＥＰ−４１０において、新たに計測領域ＫＡとなった領域の全てのグリッドｇに対してＳＴＥＰ−４０７、４０８の処理が完了したか否かを判定する。
その結果、データ処理部７０は、新たに計測領域ＫＡとなった領域の全てのグリッドｇに対してＳＴＥＰ−４０７、４０８の処理が完了した場合、ＳＴＥＰ−４１１に移行する。
一方、データ処理部７０は、新たに計測領域ＫＡとなった領域の全てのグリッドｇに対してＳＴＥＰ−４０７、４０８の処理が完了していない場合、ＳＴＥＰ−４０７に移行し、注目グリッドｇａの右隣または次の行のグリッドｇを次の注目グリッドｇａとしてＳＴＥＰ−４０７を行う。
【０１２６】
データ処理部７０は、ＳＴＥＰ−４１１において、グリッドｇにラベルが付与された三次元地図を出力して、ラベリング処理Ｃ処理を終了し、ＳＴＥＰ−１０６に移行する。
【０１２７】
以下に、荷物Ｗの搬送開始位置および搬送終了位置を含む所定の範囲について、最新の点群データに基づいて生成されたガイド情報を表示するクレーン１について説明する。
【０１２８】
図１６に示すように、制御装置１８は、荷物Ｗの搬送開始位置Ｐａおよび搬送終了位置Ｐｂを含む所定の範囲Ｎａについて、最新の点群データＰに基づく代表点ｐｒを取得する。具体的には、まず、制御装置１８は、グリッド生成処理Ａ（ＳＴＥＰ−１０３）において、荷物Ｗの搬送開始位置Ｐａおよび搬送終了位置Ｐｂを取得する。荷物Ｗの搬送開始位置Ｐａは、作業領域ＳＡにおける搬送の始点となる荷物Ｗの位置であり、手動の入力によって設定されている。荷物Ｗの搬送終了位置Ｐｂは、作業領域ＳＡにおける搬送の終点となる荷物Ｗの位置であり、手動の入力によって設定されている。所定の範囲Ｎａは、荷物Ｗの大きさに応じて設定されており、例えば、荷物Ｗの搬送開始位置Ｐａおよび搬送終了位置Ｐｂを中心として、縦横が５グリッドの長さの正方形の範囲としている。制御装置１８は、所定の範囲Ｎａに点群データＰがある場合、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとにおけるグリッドｇの代表点ｐｒを設定する（図１６（Ａ）下図参照）。尚、制御装置１８は、所定の範囲Ｎａに点群データＰがない場合、新たに計測領域ＫＡとなった領域における代表点ｐｒを設定する。
【０１２９】
次に、制御装置１８は、三次元地図更新処理Ｂ（ＳＴＥＰ−１０４）において、前回の領域推定で出力された三次元地図の代表点ｐｒ１と設定したグリッドｇ毎の代表点ｐｒ２とを用いて三次元地図を更新する。図１６（Ａ）上図は、前回の領域推定で出力された三次元地図の代表点ｐｒ１のみを示した図である。図１６（Ａ）下図は、設定したグリッドｇ毎の代表点ｐｒ２のみを示した図である。図１６（Ｂ）に示すように、制御装置１８は、代表点ｐｒ１と代表点ｐｒ２とをグリッドｇ毎に取得する。制御装置１８は、同一のグリッドｇ内に代表点ｐｒが複数ある場合（代表点ｐｒ１と代表点ｐｒ２とがある場合）、代表点ｐｒ１を削除する。制御装置１８は、削除後の全ての代表点ｐｒ毎にグリッドｇの大きさの面を生成し、計測領域ＫＡの三次元地図として出力する。
【０１３０】
図１７に示すように、制御装置１８は、ラベリング処理Ｃ（ＳＴＥＰ−１０５）において、所定の範囲Ｎａに点群データＰがある場合、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの中から順番に注目グリッドｇａを選択し、ラベルの付与およびラベルの上書きを行う。注目グリッドｇａが選択される順番は、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとにおいて、左上を起点に左端から右に、右端に到達すると一つ下の段の左端から右に選択される。尚、制御装置１８は、所定の範囲Ｎａに点群データＰがない場合、新たに計測領域ＫＡとなった領域から注目グリッドｇａを選択し、ラベルの付与およびラベルの上書きを行う。
【０１３１】
以下に、計測領域表示システム５０の制御態様について具体的に説明する。
【０１３２】
図１８に示すように、制御装置１８は、ＳＴＥＰ−２１０において、荷物Ｗの搬送開始位置Ｐａおよび搬送終了位置Ｐｂを取得し、ＳＴＥＰ−２０１に移行する。
【０１３３】
制御装置１８は、ＳＴＥＰ−２１１において、荷物Ｗの搬送開始位置Ｐａおよび搬送終了位置Ｐｂを含む所定の範囲Ｎａを認識し、ＳＴＥＰ−２１２に移行する。
【０１３４】
制御装置１８は、ＳＴＥＰ−２１２において、所定の範囲Ｎａに点群データＰがあるか否かを判定する。
その結果、制御装置１８は、所定の範囲Ｎａに点群データＰがない場合、ＳＴＥＰ−２０４に移行する。
一方、制御装置１８は、所定の範囲Ｎａに点群データＰがある場合、ＳＴＥＰ−２１３に移行する。
【０１３５】
制御装置１８は、ＳＴＥＰ−２１３において、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとを代表点ｐｒが設定される領域と定めて、ＳＴＥＰ−２０５に移行する。
【０１３６】
制御装置１８は、ＳＴＥＰ−２１４において、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの全てのグリッドｇで代表点ｐｒの設定が完了したか否かを判定する。
その結果、制御装置１８は、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの全てのグリッドｇで代表点ｐｒの設定が完了した場合、グリッド生成処理Ａを終了し、ＳＴＥＰ−１０４に移行する。
一方、制御装置１８は、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの全てのグリッドｇで代表点ｐｒの設定が完了していない場合、ＳＴＥＰ−２０５に移行して、代表点ｐｒの設定が行われていないグリッドｇに対してＳＴＥＰ−２０５を行う。
【０１３７】
図１９に示すように、制御装置１８は、ＳＴＥＰ−３０３において、同一のグリッドｇ内に複数の代表点ｐｒが存在するか否かを判定する。
その結果、制御装置１８は、同一のグリッドｇ内に複数の代表点ｐｒが存在する場合、ＳＴＥＰ−３０４に移行する。
一方、制御装置１８は、同一のグリッドｇ内に複数の代表点ｐｒが存在しない場合、ＳＴＥＰ−３０２に移行する。
【０１３８】
制御装置１８は、ＳＴＥＰ−３０４において、前回の領域推定で出力された三次元地図
の代表点ｐｒ１を削除し、ＳＴＥＰ−３０２に移行する。
【０１３９】
図２０に示すように、制御装置１８は、ＳＴＥＰ−４１２において、所定の範囲Ｎａに点群データＰがあるか否かを判定する。
その結果、制御装置１８は、所定の範囲Ｎａに点群データＰがない場合、ＳＴＥＰ−４０１に移行する。
一方、制御装置１８は、所定の範囲Ｎａに点群データＰがある場合、ＳＴＥＰ−４１３に移行する。
【０１４０】
制御装置１８は、ＳＴＥＰ−４１３において、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとを注目グリッドｇａが選択される領域と定めて、ＳＴＥＰ−４０２に移行する。
【０１４１】
制御装置１８は、ＳＴＥＰ−４１４において、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの全てのグリッドｇに対してラベルの付与が完了したか否かを判定する。
その結果、制御装置１８は、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの全てのグリッドｇに対してラベルの付与が完了した場合、ＳＴＥＰ−４０７に移行する。
一方、制御装置１８は、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの全てのグリッドｇに対してラベルの付与が完了していない場合、ＳＴＥＰ−４０２に移行し、注目グリッドｇａの右隣または次の行のグリッドｇを次の注目グリッドｇａとしてＳＴＥＰ−４０２を行う。
【０１４２】
制御装置１８は、ＳＴＥＰ−４１５において、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの全てのグリッドｇに対してＳＴＥＰ−４０７、４０８の処理が完了した否かを判定する。
その結果、制御装置１８は、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの全てのグリッドｇに対してＳＴＥＰ−４０７、４０８の処理が完了した場合、ＳＴＥＰ−４１１に移行する。
一方、制御装置１８は、新たに計測領域ＫＡとなった領域と所定の範囲Ｎａとの全てのグリッドｇに対してＳＴＥＰ−４０７、４０８の処理が完了していない場合、ＳＴＥＰ−４０７に移行し、注目グリッドｇａの右隣または次の行のグリッドｇを次の注目グリッドｇａとしてＳＴＥＰ−４０７を行う。
【０１４３】
このようなクレーン１は、荷物Ｗの搬送開始位置Ｐａおよび搬送終了位置Ｐｂを含む所定の範囲Ｎａのグリッドｇで、最新の点群データＰに基づいて重心位置と平均標高値Ｈとの算出、および隣接するグリッドｇ間の標高値の差が閾値以下か否かの判定が行われる。これにより、荷物Ｗの搬送開始位置Ｐａおよび搬送終了位置Ｐｂを含む所定の範囲Ｎａについて、最新の点群データＰに基づいて生成されたガイド情報を表示できるとともに、ガイド情報を生成する範囲が広がっても計算量の増加を抑制してガイド情報を表示できる。
【０１４４】
以下に、ブーム９の撓み、または、ブーム９の振動によるレーザスキャナ６２の位置の変動を考慮して、レーザスキャナ６２のレーザ照射時の位置毎の点群データＰを重ね合わせるクレーン１について説明する。
【０１４５】
制御装置１８は、レーザスキャナ６２の位置の変動を考慮して、レーザスキャナ６２のレーザ照射時の位置毎の点群データＰを重ね合わせる。具体的には、まず、制御装置１８は、第二ＧＮＳＳ受信機６４ｂによって旋回台７の旋回中心の位置を取得する。そして、制御装置１８は、旋回用センサ２７、伸縮用センサ２８、起伏用センサ２９、モーメントセンサ３１によって検出される旋回位置、ブーム長さ、起伏角度、ブーム９に作用するモーメントを取得する。制御装置１８は、取得した旋回台７の旋回中心の位置、旋回位置、ブーム長さ、起伏角度、ブーム９に作用するモーメントに基づいてブーム９の撓みや振れを考慮したレーザスキャナ６２の位置データＲと方位データＫとを算出する。制御装置１８は、算出した位置データＲおよび方位データＫを用いて時刻対応処理（ＳＴＥＰ−１０１）、剛体変換処理（ＳＴＥＰ−１０２）、グリッド生成処理Ａ（ＳＴＥＰ−１０３）を行う。制御装置１８は、レーザスキャナ６２の位置の変動を考慮して、傾き、位置、向きが補正された点群データＰを重ね合わせる。
【０１４６】
このようなクレーン１は、ブーム９の撓みや振動が発生したときの点群データＰと、過去の点群データＰと、が適切に重ね合わせられる。これにより、ガイド情報を生成する範囲が広がっても計算量の増加を抑制してガイド情報を表示できる。
【０１４７】
上述の実施形態は、代表的な形態を示したに過ぎず、一実施形態の骨子を逸脱しない範囲で種々変形して実施することができる。さらに種々なる形態で実施し得ることは勿論のことであり、本発明の範囲は、特許請求の範囲の記載によって示され、さらに特許請求の範囲に記載の均等の意味、および範囲内のすべての変更を含む。
【符号の説明】
【０１４８】
１      クレーン
６２    レーザスキャナ
７０    データ処理部
ｇ      グリッド
ＫＡ    計測領域
Ｈ      平均標高値
Ｐ      点群データ
ｐｒ    代表点
【図１】
2020095342.tif 000003
【図２】
2020095342.tif 000004
【図３】
2020095342.tif 000005
【図４】
2020095342.tif 000006
【図５】
2020095342.tif 000007
【図６】
2020095342.tif 000008
【図７】
2020095342.tif 000009
【図８】
2020095342.tif 000010
【図９】
2020095342.tif 000011
【図１０】
2020095342.tif 000012
【図１１】
2020095342.tif 000013
【図１２】
2020095342.tif 000014
【図１３】
2020095342.tif 000015
【図１４】
2020095342.tif 000016
【図１５】
2020095342.tif 000017
【図１６】
2020095342.tif 000018
【図１７】
2020095342.tif 000019
【図１８】
2020095342.tif 000020
【図１９】
2020095342.tif 000021
【図２０】
2020095342.tif 000022