JP7272848B2 - 荷揚げ装置 - Google Patents

Description

本開示は、荷揚げ装置に関する。

荷揚げ装置は、船庫内に積載された積荷を、船庫外に搬出する。荷揚げ装置の一例としてアンローダ装置がある。アンローダ装置では、積荷の状態や、船庫の壁面までの距離等を操縦者が直接目視することが困難または不可能なことが多い。アンローダ装置では、掻取部にセンサを取り付け、船庫の壁までの距離を計測する技術（例えば、特許文献１）が開発されている。

特開平８－０１２０９４号公報

上記特許文献１に記載されたような技術では、船庫内の積荷の状況を把握することが困難である。

本開示は、このような課題に鑑み、積荷の状況を容易に把握させることが可能な荷揚げ装置を提供することを目的としている。

上記課題を解決するために、本開示の一態様に係る荷揚げ装置は、船舶の特定位置を基準として、３次元に展開する複数の小領域で構成される作業領域を生成する領域生成部と、測距センサによって計測された船庫内の積荷の計測点における計測データを随時取得する計測データ取得部と、計測点の計測データに基づいて、計測点が含まれる小領域について、計測点の統計データを異なる複数の時刻にわたって蓄積する積荷データ蓄積部と、上下方向に並んで配置される複数の小領域のうち、統計データが蓄積されており、かつ、最も下方に位置する小領域を抽出し、抽出した小領域に基づいて船庫内の積荷の表面高さを導出する積荷高さ導出部と、を備える。

荷揚げ装置は、積荷高さ導出部によって導出された積荷の表面高さを表示部に表示する表示制御部を備えてもよい。

表示制御部は、積荷の表面高さを、積荷を掻き取る掻取部との相対高さで表示してもよい。

積荷データ蓄積部は、測距センサによって計測された所定時間の計測点の計測データを蓄積してもよい。

領域生成部は、複数の作業領域を生成し、データ蓄積部は、複数の作業領域のうち、時間ごとに異なる作業領域を用いて、統計データを蓄積してもよい。

表示制御部は、特定位置に対する掻取部の位置を導出し、積荷の高さに掻取部の形状を重畳して表示してもよい。

測距センサは、掻取部を中心に互いに反対側であって、水平より下向きに計測するように２個以上取り付けられてもよい。

領域生成部は、船舶の開口部を基準として、作業領域を生成してもよい。

荷揚げ装置は、積荷の状況を容易に把握させることが可能となる。

アンローダ装置の概要を説明する図である。 アンローダ装置の構成を説明する図である。 測距センサの計測範囲を説明する図である。 測距センサの計測範囲を説明する図である。 測距センサの計測範囲を説明する図である。 測距センサの計測範囲を説明する図である。 アンローダ装置の電気的な構成を説明する図である。 船庫の３次元形状を導出する処理の流れを示すフローチャートである。 アンローダ装置の座標系を説明する図である。 アンローダ装置の座標系を説明する図である。 複数の小領域で構成される作業領域を説明する図である。 測距センサの計測点を説明する図である。 エッジ点を検出する様子を示す図である。 測距センサで計測される計測点を上部および下部に分割する様子を説明する図である。 底面形状導出処理を説明する図である。 側壁に対応する小領域を導出する様子を説明する図である。 積荷の表面高さを表示する処理の流れを示すフローチャートである。 積荷表面高さ導出処理を説明する図である。 積荷高さ表示画像の一例を説明する図である。

以下に添付図面を参照しながら、本開示の一実施形態について詳細に説明する。かかる実施形態に示す寸法、材料、その他具体的な数値等は、理解を容易とするための例示にすぎず、特に断る場合を除き、本開示を限定するものではない。なお、本明細書および図面において、実質的に同一の機能、構成を有する要素については、同一の符号を付することにより重複説明を省略し、また本開示に直接関係のない要素は図示を省略する。

図１は、アンローダ装置１００の概要を説明する図である。図１に示すように、荷揚げ装置の一例としてのアンローダ装置１００は、岸壁２に沿って敷設された一対のレール３上を、レール３の延在方向に走行可能である。アンローダ装置１００は、岸壁２に停泊された船舶４の船庫５内に積載された積荷６を外部に搬出する。積荷６は、ばら荷が想定されており、一例として石炭が挙げられる。

図２は、アンローダ装置１００の構成を説明する図である。なお、図２では、岸壁２および船舶４を断面で示している。図２に示すように、アンローダ装置１００は、走行体１０２、旋回体１０４、ブーム１０６、トップフレーム１０８、エレベータ１１０、掻取部１１２、ブームコンベア１１４を含んで構成される。

走行体１０２は、不図示のアクチュエータが駆動することで、レール３上を走行可能である。走行体１０２には、位置センサ１１６が設けられる。位置センサ１１６は、例えばロータリーエンコーダである。位置センサ１１６は、走行体１０２の車輪の回転数に基づき、所定の原点位置に対する走行体１０２の水平面上の位置を計測する。

旋回体１０４は、走行体１０２の上部に、垂直軸を中心に旋回自在に設けられる。旋回体１０４は、不図示のアクチュエータが駆動することで、走行体１０２に対して旋回可能である。

ブーム１０６は、旋回体１０４の上部に、傾斜角度を変更可能に設けられる。ブーム１０６は、不図示のアクチュエータが駆動することで、旋回体１０４を基準とした傾斜角度を変更可能である。

旋回体１０４には、旋回角度センサ１１８および傾斜角度センサ１２０が設けられる。旋回角度センサ１１８および傾斜角度センサ１２０は、例えばロータリーエンコーダである。旋回角度センサ１１８は、走行体１０２に対する旋回体１０４の旋回角度を計測する。傾斜角度センサ１２０は、旋回体１０４に対するブーム１０６の傾斜角度を計測する。

トップフレーム１０８は、ブーム１０６の先端に設けられる。トップフレーム１０８には、エレベータ１１０を旋回させるアクチュエータが設けられる。

エレベータ１１０は、略円柱形状に形成される。エレベータ１１０は、中心軸を中心として旋回自在にトップフレーム１０８に支持される。トップフレーム１０８には、旋回角度センサ１２２が設けられる。旋回角度センサ１２２は、例えばロータリーエンコーダである。旋回角度センサ１２２は、トップフレーム１０８に対するエレベータ１１０の旋回角度を計測する。

掻取部１１２は、エレベータ１１０の下端に設けられる。掻取部１１２は、エレベータ１１０の旋回に伴って、エレベータ１１０と一体的に旋回する。このように、掻取部１１２は、垂直運搬機構部として機能するトップフレーム１０８およびエレベータ１１０によって旋回自在に保持される。

掻取部１１２は、複数のバケツ１１２ａおよびチェーン１１２ｂが設けられる。複数のバケツ１１２ａは、チェーン１１２ｂに連続的に配置される。チェーン１１２ｂは、掻取部１１２、および、エレベータ１１０の内部に架け渡される。

掻取部１１２は、不図示のリンク機構が設けられる。リンク機構は、可動することにより、掻取部１１２の底部の長さを可変させる。これにより、掻取部１１２は、船庫５内の積荷６と接するバケツ１１２ａの数を可変させる。掻取部１１２は、チェーン１１２ｂを回動させることにより、底部のバケツ１１２ａによって船庫５内の積荷６を掻き取る。そして、積荷６を掻き取ったバケツ１１２ａは、チェーン１１２ｂの回動に伴ってエレベータ１１０の上部に移動する。

ブームコンベア１１４は、ブーム１０６の下方に設けられる。ブームコンベア１１４は、バケツ１１２ａによってエレベータ１１０の上部に移動された積荷６を外部に搬出させる。

このような構成でなるアンローダ装置１００は、走行体１０２によってレール３の延在方向に移動し、船舶４との長手方向の相対位置関係を調整する。また、アンローダ装置１００は、旋回体１０４によって、ブーム１０６、トップフレーム１０８、エレベータ１１０および掻取部１１２を旋回させ、船舶４との短手方向の相対位置関係を調整する。また、アンローダ装置１００は、ブーム１０６によって、トップフレーム１０８、エレベータ１１０および掻取部１１２を鉛直方向に移動させ、船舶４との鉛直方向の相対位置関係を調整する。また、アンローダ装置１００は、トップフレーム１０８によってエレベータ１１０および掻取部１１２を旋回させる。これにより、アンローダ装置１００は、掻取部１１２を任意の位置および角度に移動させることができる。

ここで、船舶４は、複数の船庫５が設けられる。船庫５は、上部にハッチコーミング７が設けられる。ハッチコーミング７は、鉛直方向に所定高さの壁面を有している。また、ハッチコーミング７は、船庫５における中央付近の水平断面に比べて、開口面積が小さい。つまり、船庫５は、ハッチコーミング７により開口が窄まった形状をしている。なお、ハッチコーミング７の上方には、ハッチコーミング７を開閉するハッチカバー８が設けられる。

アンローダ装置１００には、測距センサ１３０～１３６が設けられる。測距センサ１３０～１３６は、例えば、測距可能なレーザセンサであり、Ｖｅｌｏｄｙｎｅ社製のＶＬＰ－１６、ＶＬＰ－３２、Ｑｕａｎｅｒｇｙ社製のＭ８等が適用される。測距センサ１３０～１３６は、例えば円柱形状の本体部の側面に、軸方向に沿って離隔した１６のレーザー照射部が設けられる。レーザー照射部は、３６０度回転可能に本体部に設けられる。レーザー照射部は、互いに隣接して配置されたレーザー照射部との軸方向のレーザーの発射角度の差が１～２．５度間隔で均等となるようにそれぞれ配置される。つまり、測距センサ１３０～１３６は、本体部の周方向に３６０度の範囲でレーザーを照射可能である。また、測距センサ１３０～１３６は、本体部の軸方向に直交する平面を基準として、±１５度の範囲でレーザーを発射可能である。また、測距センサ１３０～１３６は、レーザーを受信する受信部が本体部に設けられる。

測距センサ１３０～１３６は、レーザー照射部を回転させながら所定角度毎にレーザーを照射する。測距センサ１３０～１３６は、複数のレーザー照射部から照射（投影）されて物体（計測点）で反射したレーザーを受信部でそれぞれ受信する。そして、測距センサ１３０～１３６は、レーザーが照射されてから受信するまでの時間に基づいて、物体までの距離を導出する。つまり、測距センサ１３０～１３６は、１つのレーザー照射部によって、１つの計測ライン上で複数の計測点までの距離をそれぞれ計測する。また、測距センサ１３０～１３６は、複数のレーザー照射部によって、複数の計測ライン上での複数の計測点までの距離をそれぞれ計測する。

図３および図４は、測距センサ１３０～１３２の計測範囲を説明する図である。図３は、アンローダ装置１００を上方から見た際の測距センサ１３０～１３２の計測範囲を説明する図である。図４は、アンローダ装置１００を側方から見た際の測距センサ１３０～１３２の計測範囲を説明する図である。図３および図４において、測距センサ１３０～１３２の計測範囲を一点鎖線で示す。

測距センサ１３０～１３２は、主に、ハッチコーミング７を検出する際に用いられる。測距センサ１３０～１３２は、図３および図４に示すように、トップフレーム１０８の側面に取り付けられる。具体的には、測距センサ１３０～１３２は、エレベータ１１０の中心軸を基準として、周方向に互いに１２０度離して配置される。また、測距センサ１３０～１３２は、本体部の中心軸が、エレベータ１１０の径方向に沿うように配置される。なお、測距センサ１３０～１３２は、鉛直方向の上半分が不図示のカバーで覆われる。

したがって、測距センサ１３０～１３２は、図３および図４に示すように、計測方向として、水平面よりも下方であって、トップフレーム１０８の側面に接する接線を基準として±１５度の範囲に存在する物体までの距離を計測することができる。

図５および図６は、測距センサ１３３～１３６の計測範囲を説明する図である。図５は、掻取部１１２を上方から見た際の測距センサ１３３～１３６の計測範囲を説明する図である。なお、図５では、アンローダ装置１００のうち、掻取部１１２のみを図示している。また、図５では、船舶４について、掻取部１１２と鉛直方向の同位置での水平断面を示している。図６は、アンローダ装置１００を側方から見た際の測距センサ１３３～１３６の計測範囲を説明する図である。図５および図６において、測距センサ１３３、１３４の計測範囲を一点鎖線で示す。また、図５および図６において、測距センサ１３５、１３６の計測範囲を二点鎖線で示す。

測距センサ１３３～１３６は、主に、船庫５内の積荷６、および、船庫５の壁面（側壁および底面）を検出する際に用いられる。測距センサ１３３は、図５および図６に示すように、掻取部１１２の側面１１２ｃに取り付けられる。測距センサ１３３は、本体部の中心軸が、掻取部１１２の側面１１２ｃに直交するように配置される。測距センサ１３４は、掻取部１１２の側面１１２ｄに取り付けられる。測距センサ１３４は、本体部の中心軸が、掻取部１１２の側面１１２ｄに直交するように配置される。測距センサ１３３、１３４は、鉛直方向の一部が不図示のカバーで覆われる。

したがって、測距センサ１３３、１３４は、計測方向として、掻取部１１２の側面１１２ｃおよび側面１１２ｄの上方側の一部および下方側であって、掻取部１１２の側面１１２ｃおよび側面１１２ｄと平行な位置を基準として±１５度の範囲に存在する物体の距離を計測することができる。つまり、測距センサ１３３、１３４は、掻取部１１２を中心に互いに反対側（進行方向の前後）であって、水平より下向きに計測するように取り付けられる。なお、本実施形態の測距センサ１３３、１３４は、掻取部１１２の底部が位置する平面上において、少なくとも掻取部１１２の底部の最大長さ以上の範囲を計測できるように配置される。

測距センサ１３５は、掻取部１１２の側面１１２ｃに取り付けられる。測距センサ１３５は、本体部の中心軸が、掻取部１１２の底面と直交するように配置される。測距センサ１３６は、掻取部１１２の側面１１２ｄに取り付けられる。測距センサ１３６は、本体部の中心軸が、掻取部１１２の底面と直交するように配置される。

したがって、測距センサ１３５、１３６は、計測方向として、掻取部１１２の外方であって、掻取部１１２の側面１１２ｃおよび側面１１２ｄに直交する水平面(あるいは、本体部の中心軸と直交する平面)を基準として±１５度の範囲に存在する物体の距離を計測することができる。

測距センサ１３０～１３６は、物体までの距離を計測すると、物体までの距離を示す計測データをアンローダ制御部１４０（図７参照）に送信する。

図７は、アンローダ装置１００の電気的な構成を説明する図である。図７に示すように、アンローダ装置１００には、アンローダ制御部１４０、記憶部１４２および表示部１４４が設けられる。

アンローダ制御部１４０は、位置センサ１１６、旋回角度センサ１１８、傾斜角度センサ１２０、旋回角度センサ１２２、測距センサ１３０～１３６、記憶部１４２および表示部１４４と接続される。アンローダ制御部１４０は、ＣＰＵ（中央処理装置）を含む半導体集積回路で構成される。アンローダ制御部１４０は、ＲＯＭからＣＰＵ自体を動作させるためのプログラムやパラメータ等を読み出す。そして、アンローダ制御部１４０は、ワークエリアとしてのＲＡＭや他の電子回路と協働して、アンローダ装置１００全体を管理および制御する。

また、アンローダ制御部１４０は、駆動制御部１５０、領域生成部１５２、エッジ検出部１５４、計測データ取得部１５６、座標変換導出部１５８、データ蓄積部１６０、ノイズ除去部１６２、形状導出部１６４、積荷データ蓄積部１６６、積荷高さ導出部１６８、表示制御部１７０として機能する。データ蓄積部１６０は、上部データ蓄積部１８０および下部データ蓄積部１８２としても機能する。形状導出部１６４は、底面形状導出部１９０および側壁形状導出部１９２としても機能する。駆動制御部１５０は、アンローダ装置１００の駆動を制御する。なお、アンローダ制御部１４０の他の機能部の詳細については後述する。

記憶部１４２は、ハードディスク、不揮発性メモリ等の記憶媒体である。記憶部１４２は、アンローダ装置１００の３次元モデルのデータを記憶する。アンローダ装置１００の３次元モデルのデータは、エレベータ１１０および掻取部１１２の少なくとも外形形状が示されるボクセルデータである。また、記憶部１４２は、詳しくは後述するように、形状導出部１６４により導出された船庫５の３次元形状が示される３次元モデルのデータを記憶する。なお、３次元モデルのデータは、アンローダ装置１００および船庫５の３次元形状が把握可能なデータであればよく、ポリゴンデータ、輪郭（直線）や点群等であってもそれらを併用してもよい。また、船庫５の３次元モデルのデータは、船舶４ごとに、その船舶４に設けられる船庫５の数分だけ記憶部１４２に記憶される。

表示部１４４は、ＬＥＤディスプレイ、有機ＥＬディスプレイ等である。表示部１４４には、船庫５の３次元モデルに対してアンローダ装置１００の３次元モデルが配置された画像が表示される。

図８は、船庫５の３次元形状を導出する処理の流れを示すフローチャートである。なお、船庫５の３次元形状を導出する処理は、アンローダ装置１００によって積荷６を初めて掻き取る（まだ船庫５の形状が明確ではない）船庫５に対して行われることを前提としている。したがって、同一の船庫５に対して２回目以降（船庫５の形状が明確になった後）に積荷６が掻き取られるときには、船庫５の３次元形状を導出する処理が行われない。

図８に示すように、船庫５の３次元形状を導出する処理を開始すると、まず、領域生成部１５２は、ハッチコーミング座標系３２０（図９、図１０参照）を基準とした（船庫５を基準とした）作業領域４００（図１１参照）を作成する領域作成処理を行う（Ｓ１００）。作業領域は、仮想的に生成した３次元空間に稠密に小領域群が配置されたものである。本実施形態では、立方格子状に立方体の小領域（ボクセル）が配列された空間（所謂ボクセル空間）を用いる。

図９および図１０は、アンローダ装置１００の座標系を説明する図である。図９は、アンローダ装置１００を上方から見た図である。図１０は、アンローダ装置１００を側方から見た図である。ここで、アンローダ装置１００は、３つの座標系、すなわち、地上座標系３００、トップフレーム座標系３１０およびハッチコーミング座標系３２０を有する。

図９および図１０に示すように、地上座標系３００は、予め設定されたアンローダ装置１００の初期位置を原点としている。地上座標系３００は、レール３の延在方向および鉛直方向に直交する方向をＸａ軸方向とする。地上座標系３００は、レール３の延在方向をＹａ軸方向とする。地上座標系３００は、鉛直方向をＺａ軸方向とする。

トップフレーム座標系３１０は、エレベータ１１０の中心軸上であって、鉛直方向におけるトップフレーム１０８の下端を原点としている。トップフレーム座標系３１０は、ブーム１０６の下面の延在方向であって、ブーム１０６に沿った方向をＸｂ軸方向とする。トップフレーム座標系３１０は、ブーム１０６の下面の延在方向であって、ブーム１０６に直交する方向をＹｂ軸方向とする。トップフレーム座標系３１０は、エレベータ１１０の延在方向をＺｂ軸方向とする。

ハッチコーミング座標系３２０は、船舶４のハッチコーミング７における船尾側の壁面の中心位置であって、ハッチコーミング７の上端を原点（特定位置）としている。ハッチコーミング座標系３２０は、船舶４の長手方向、つまり、船舶４に沿ったハッチコーミング７の延在方向をＸｃ軸方向とする。ハッチコーミング座標系３２０は、船舶４の短手方向（幅方向）をＹｃ軸方向とする。ハッチコーミング座標系３２０は、ハッチコーミング７の上端面に直交する上方向をＺｃ軸方向とする。

図１１は、複数の小領域４０２で構成される作業領域４００を説明する図である。なお、図１１では、船庫５を一点鎖線で図示している。図１１に示すように、領域生成部１５２は、ハッチコーミング座標系３２０において、原点Ｏを基準として３次元に展開された複数の小領域（ボクセル）４０２を配置することで作業領域４００を生成する。作業領域４００は、複数の小領域４０２が、Ｘｃ軸方向、Ｙｃ軸方向およびＺｃ軸方向に並んで配置される。より具体的には、領域生成部１５２は、Ｘｃ軸方向およびＹｃ軸方向には、正方向および負方向の両方に小領域４０２を配置し、Ｚｃ軸方向には負方向にのみ小領域４０２を配置する。小領域４０２は、例えば１辺が０．２～１ｍの直方体である。

作業領域４００は、全体として船庫５よりも大きければよく、小領域４０２の数および１辺の長さは適宜選択可能である。また、作業領域４００は、全体としてＺｃ軸方向を軸中心とした円筒形状であってもよく、その場合、小領域４０２のＸＹ平面の断面が扇型となるように形成すればよい。

なお、領域生成部１５２は、同一の作業領域４００を２つ作成する。また、小領域４０２には、詳しくは後述するように、それぞれ、計測点の数を示す投票回数、Ｘｃ軸方向における計測点の座標の総和、Ｙｃ軸方向における計測点の座標の総和、Ｚｃ軸方向における計測点の座標の総和、測距センサ１３３または１３４までの最小距離、計測点から測距センサ１３３または１３４に向かう計測方向ベクトルといった統計データが対応付けて記憶される。なお、統計データとしてここに記載される項目は一例であり、例えば分散値等の他の項目を蓄積してもよい。

図８に戻り、エッジ検出部１５４は、記憶部１４２に記憶されたハッチコーミング７の３次元モデル情報を記憶部１４２から読み出す（Ｓ１０２）。なお、ハッチコーミング７の３次元モデル情報は、ハッチコーミング座標系３２０によって表されるハッチコーミング７の３次元モデルである。ハッチコーミング７の３次元モデル情報は、掻取部１１２を初めて船庫５内に投入する際に、測距センサ１３０～１３２によって計測された計測点の計測データを用いて作成されてもよい。また、ハッチコーミング７の３次元モデル情報は、他の計測器により計測された計測データを用いて作成されてもよい。また、ハッチコーミング７の３次元モデル情報は、ハッチコーミング７の図面に基づいて作成されてもよい。いずれにしても、ハッチコーミング７の３次元モデル情報は、Ｓ１０２の処理が行われるまでに作成され記憶部１４２に記憶されていればよい。

続いて、計測データ取得部１５６は、測距センサ１３０～１３６で計測された計測点の計測データを随時取得する（Ｓ１０４）。なお、計測データ取得部１５６は、掻取部１１２が船庫５内の積荷６の掻き取り作業を開始してから、全ての積荷６を掻き取り終えるまでの間（例えば１０時間）、各測距センサ１３０～１３６から計測データを１秒に１～５回の頻度で定期的に取得する。

そして、計測データ取得部１５６により測距センサ１３０～１３６から計測データが取得される度に、座標変換導出部１５８は、トップフレーム座標系３１０をハッチコーミング座標系３２０に変換するための変換パラメータを導出する座標変換処理を行う（Ｓ１０６）。

ここで、地上座標系３００、トップフレーム座標系３１０は、アンローダ装置１００の形状、および、アンローダ装置１００の移動に基づいて変換が可能である。

例えば、測距センサ１３３～１３６は、掻取部１１２に取り付けられているため、掻取部１１２に対する位置は予め既知となっている。そして、エレベータ１１０の旋回角度に基づいて、トップフレーム座標系３１０の位置を導出することができる。

また、測距センサ１３０～１３２は、トップフレーム１０８に取り付けられているため、トップフレーム座標系３１０の位置が予め既知となっている。

ここで、トップフレーム座標系３１０と、ハッチコーミング座標系３２０とは、アンローダ装置１００および船舶４の移動に伴って相対的な位置関係が変化する。例えば、船舶４が揺れたり、潮の満ち引きや積荷６の積載量によって船舶４が鉛直方向に移動したりすることで、トップフレーム座標系３１０と、ハッチコーミング座標系３２０とは、相対的な位置関係が変化する。

そこで、エッジ検出部１５４は、測距センサ１３０～１３２により測定される計測点の計測データに基づいてハッチコーミング７の上端のエッジを検出する。そして、座標変換導出部１５８は、検出したハッチコーミング７の上端のエッジに基づいて、トップフレーム座標系３１０をハッチコーミング座標系３２０に変換するための変換パラメータを導出する。つまり、ここでは、作業領域４００において基準点となるハッチコーミング７と、測距センサ１３３あるいは１３４との位置関係を導出する。そして、その位置関係は、作業領域４００内における小領域４０２への測距センサ１３３、１３４で計測される計測点の反映に用いる。

まず、エッジ検出部１５４は、測距センサ１３０～１３２の位置、および、測距センサ１３０～１３２により計測された計測点までの距離に基づいて、トップフレーム座標系３１０における計測点の３次元位置を導出する。

図１２は、測距センサ１３０～１３２の計測点を説明する図である。なお、図１２では、ハッチコーミング７上の測距センサ１３０～１３２の計測範囲を太線で示す。図１２に示すように、測距センサ１３０～１３２は、水平面よりも下方であって、トップフレーム１０８に接する平面を基準として測距センサ１３０～１３２から±１５度の範囲に存在する物体までの距離を計測する。

したがって、測距センサ１３０～１３２は、測距センサ１３０～１３２の鉛直下方（エレベータ１１０の回転中心）を基準として、前方側と後方側とで異なるハッチコーミング７のエッジが計測範囲となる。なお、前方側とは、１回の計測において（時系列の）前半に計測された計測範囲をいう。また、後方側とは、１回の計測において（時系列の）後半に計測された計測範囲をいう。

そこで、測距センサ１３０～１３２で計測された測定点を、測距センサ１３０～１３２の鉛直下方を基準として、前方側および後方側の２つに分割する。

図１３は、エッジ点を検出する様子を示す図である。なお、図１３において、計測点を黒丸で示す。図１３では、測距センサ１３０～１３２の１つのレーザー照射部に照射されたレーザーによって計測された計測点を図示している。

エッジ検出部１５４は、１つのレーザー照射部により照射されて計測された１つの計測ラインの計測点群毎（前方側、後方側毎）に以下の処理を行う。エッジ検出部１５４は、１つのレーザー照射部により照射されて計測された各計測点のベクトル（方向）を導出する。なお、計測点のベクトルは、連続して計測される計測点のうち、１の計測点に対する、次に計測される計測点の方向（ベクトル）を、１の計測点のベクトルとして導出する。

そして、エッジ検出部１５４は、計測点のベクトルが鉛直方向とされる計測点を抽出する。これは、測距センサ１３０～１３２により計測されるハッチコーミング７の壁面（側面）が概ね鉛直方向に延在しているので、ハッチコーミング７の壁面に計測点がある場合、計測点のベクトルが鉛直方向となるからである。

そして、エッジ検出部１５４は、抽出された計測点のうち、連続して抽出された計測点が複数ある場合、鉛直方向における最も上方の点を抽出する。これは、ハッチコーミング７の上端のエッジを検出するため、連続して計測された計測点群においては、最も上方の点が、ハッチコーミング７の上端のエッジである可能性があるからである。

続いて、エッジ検出部１５４は、抽出された計測点のうち、トップフレーム座標系３１０におけるＸｂ軸方向およびＹｂ軸方向における最も原点に近い計測点を抽出する。つまり、エッジ検出部１５４は、エレベータ１１０の中心軸に最も近い計測点を抽出する。これは、ハッチコーミング７が船舶４の各構造物のうち、最もエレベータ１１０に近い位置にあるからである。

そして、エッジ検出部１５４は、抽出された計測点に対して、トップフレーム座標系３１０におけるＸｂ軸方向およびＹｂ軸方向の所定の範囲（例えば数十ｃｍの範囲）に存在する計測点を再抽出する。ここでは、ハッチコーミング７上の計測点を抽出することになる。

そして、エッジ検出部１５４は、再抽出した計測点、つまり、ハッチコーミング７上の計測点のうち、鉛直方向における最も上方の計測点をハッチコーミング７のエッジ点として抽出する。

エッジ検出部１５４は、測距センサ１３０～１３２の１つのレーザー照射部により照射されて計測された計測点群毎に、前方側および後方側のエッジ点を抽出する。

そして、全てのエッジ点が抽出されると、エッジ検出部１５４は、ハッチコーミング７のエッジの直線を検出する。具体的には、エッジ検出部１５４は、測距センサ１３０の前方側でそれぞれ抽出されたエッジ点を１つのグループとする。同様に、エッジ検出部１５４は、測距センサ１３０の後方側でそれぞれ抽出されたエッジ点を１つのグループとする。さらに、エッジ検出部１５４は、測距センサ１３１、１３２の前方側および後方側でそれぞれ抽出されたエッジ点をそれぞれグループとする。

ここで、図１２に示したように、測距センサ１３０～１３２の前方側および後方側でそれぞれ計測されるハッチコーミング７の上端のエッジの直線は、ハッチコーミング７の角を含む場合、２本計測されることになる。

そこで、エッジ検出部１５４は、グループごとに、抽出されたエッジ点間の線分のうち、最も多くの類似の線分をもつものを候補ベクトルとして導出する。そして、エッジ検出部１５４は、候補ベクトルに対して予め設定された範囲以内に存在するエッジ点を抽出する。そして、エッジ検出部１５４は、抽出したエッジ点を用いて直線を再計算する。

次に、エッジ検出部１５４は、抽出されなかったエッジ点を用いて上記した処理を繰り返し行う。ただし、抽出されたエッジ点の数が、予め設定された閾値未満である場合、直線を導出しない。これにより、ハッチコーミング７の角を含む場合であっても、２本のエッジの直線を導出することができる。

エッジ検出部１５４は、グループごとに、上記した処理を繰り返し行うことで、エッジの直線を導出する。

このように、エッジの直線は、１箇所で最大２個検出されるため、最大で１２本検出されることになる。

そして、エッジ検出部１５４は、検出された直線のうち、各直線間におけるなす角を導出する。そして、エッジ検出部１５４は、なす角が予め決められた閾値以下である場合、同一の直線であるとして統合する。具体的には、なす角が予め決められた閾値以下である直線を構成するエッジ点を用いて、最小二乗近似により直線を再導出する。

続いて、エッジ検出部１５４は、検出したエッジの直線から、各辺の３次元方向ベクトル、各辺の３次元重心座標、各辺の長さ、各辺の端点の座標を含むエッジ辺情報を導出する。このように、船舶４の上方に設けられた測距センサ１３０～１３２を用いて、船庫５の上部に設けられたハッチコーミング７のエッジ辺情報を導出することで、船庫５の位置（姿勢）を精度よく容易に導出することが可能となる。

次に、座標変換導出部１５８は、Ｓ１０２で読み込んだ３次元モデル情報と、トップフレーム座標系３１０で表現されるエッジ辺情報（検出結果）とに基づいて、トップフレーム座標系３１０とハッチコーミング座標系３２０との変換パラメータを導出する座標変換処理を行う（図８のＳ１０６）。

座標変換導出部１５８は、ブーム１０６の旋回角度だけ、検出したハッチコーミング７のエッジの直線の向きを回転させることで大まかな補正を行う。また、座標変換導出部１５８は、検出したハッチコーミング７のエッジの直線と、３次元形状情報におけるハッチコーミング７の上端の辺とを、エッジの向きが最も近い直線同士を対応付ける。これにより、正しい対応付けがなされるため、安定して正解に近い解の変換パラメータが得られる。なお、対応付けにおいては、検出したハッチコーミング７のエッジの直線を３次元点群で表し、その３次元点群と、３次元モデル情報におけるハッチコーミング７の上端の辺との最短距離の平均値が近いもの同士を対応付けてもよい。また、エッジの向きおよび最短距離の平均値の双方を考慮して対応付けてもよい。

そして、座標変換導出部１５８は、変換パラメータである、Ｘｂ軸、Ｙｂ軸、Ｚｂ軸回りの回転角度α、β、γと、進行ベクトルｔ＝（ｔｘ，ｔｙ，ｔｚ）とを例えばＬＭ法により求める。ＬＭ法では、例えばエッジの直線を構成するエッジ点と、３次元形状情報に基づくハッチコーミング７の上端の辺との距離の差の二乗和を評価関数とし、その評価関数を最小にする変換パラメータを求める。具体的には、エッジの直線を構成するエッジ点と３次元形状情報に基づくハッチコーミング７の上端の辺との距離の合計、または、エッジの直線と３次元形状情報に基づくハッチコーミング７の上端の辺とにより形成される曲面の面積が最小となるように変換パラメータを求める。なお、変換パラメータを求める手法は、ＬＭ法に限らず、最急降下法、ニュートン法など他の手法であってもよい。

このようにして、座標変換導出部１５８は、トップフレーム座標系３１０をハッチコーミング座標系３２０に変換するための変換パラメータを導出する。

これにより、アンローダ装置１００は、掻取部１１２に設けられた測距センサ１３３～１３６によって計測された計測点の３次元位置をハッチコーミング座標系３２０で表現することが可能となる。したがって、測距センサ１３３～１３６は、船庫５の計測点におけるハッチコーミング座標系３２０の３次元位置（位置情報）に関する計測データを計測しているとも言える。また、ハッチコーミング座標系３２０で表現することで、アンローダ装置１００に対する船舶４の揺れ、位置の変化の影響を低減することができる。

データ蓄積部１６０は、測距センサ１３３および１３４により計測された計測点の３次元位置に基づいて、作業領域４００に形成された小領域４０２に対して計測点の統計データを蓄積していく（図８のＳ１０８、Ｓ１１０）。

図１４は、測距センサ１３３で計測される計測点を上部および下部に分割する様子を説明する図である。なお、図１４において、測距センサ１３３の計測範囲を一点鎖線で示す。上記したように、測距センサ１３３は、鉛直方向の一部が不図示のカバーで覆われる。したがって、図１４に示すように、測距センサ１３３は、エレベータ１１０の延在方向に直交する平面Ｓ１を基準として、相対的に上部（エレベータ１１０側）と、相対的に下部（掻取部１１２の底面側）とに存在する物体（計測点）までの距離を計測可能である。同様に、測距センサ１３４は、エレベータ１１０の延在方向に直交する平面Ｓ１を基準として、上部と下部とに存在する物体（計測点）までの距離を計測可能である。なお、上部および下部を分ける基準は、積荷６の表面が計測範囲に入らない高さで設定すればよい。

そして、掻取部１１２が船庫５内に挿入されている場合、測距センサ１３３および１３４は、主に、上部の計測点によって船庫５の側壁、船庫５内の構造物（これらを合わせて船庫５の側部とも呼ぶ）までの距離を計測し、下部の計測点によって船庫５の底面、船庫５の側壁、船庫５内の構造物、および、積荷６（これらを合わせて船庫５の底部とも呼ぶ）までの距離を計測することになる。

そこで、データ蓄積部１６０は、測距センサ１３３および１３４により計測された計測点の計測データを、上部の計測点の計測データと下部の計測点の計測データとに分けて、異なる作業領域４００に形成された小領域４０２に対して統計データを蓄積していく。

上部データ蓄積部１８０は、測距センサ１３３および１３４により計測された計測点のうち、上部の計測点のトップフレーム座標系３１０の３次元位置を導出する。また、上部データ蓄積部１８０は、トップフレーム座標系３１０の３次元位置を、変換パラメータを用いてハッチコーミング座標系３２０の３次元位置に変換する。

そして、上部データ蓄積部１８０は、上部用の作業領域４００を用いて、ハッチコーミング座標系３２０における計測点の３次元位置に対応する小領域４０２に統計データを蓄積する上部計測データ蓄積処理を行う（図８のＳ１０８）。具体的には、１点の計測データを受けて、上部データ蓄積部１８０は、対応する小領域４０２の投票回数（計測点の数）を１加算する。また、上部データ蓄積部１８０は、計測点のＸｃ軸方向の位置（座標）を、Ｘｃ軸方向の座標の総和に加算する。また、上部データ蓄積部１８０は、計測点のＹｃ軸方向の位置（座標）を、Ｙｃ軸方向の座標の総和に加算する。また、上部データ蓄積部１８０は、計測点のＺｃ軸方向の位置（座標）を、Ｚｃ軸方向の総和に加算する。１回の計測で複数点の計測が行われるため、１回の計測で小領域４０２に複数回の加算が行われることもある。ここで、Ｘｃ軸方向の座標の総和を投票回数で除算することで、小領域４０２に含まれる計測点のＸｃ軸方向の重心位置が導出可能である。したがって、投票回数、Ｘｃ軸方向の座標の総和、Ｙｃ軸方向の座標の総和、計測点のＺｃ軸方向の位置（座標）を蓄積していくことで、小領域４０２の３次元の重心位置が導出可能となる。

また、上部データ蓄積部１８０は、計測点と、その計測点を計測したときの測距センサ１３３または１３４の位置との間の距離を導出する。なお、測距センサ１３３または１３４のトップフレーム座標系３１０の３次元位置は、変換パラメータを用いてハッチコーミング座標系３２０に変換される。なお、ここでは、ハッチコーミング座標系３２０に変換せずに、計測点と、その計測点を計測したときの測距センサ１３３または１３４の位置との間の距離を導出するようにしてもよい。

そして、上部データ蓄積部１８０は、導出した距離と、その小領域４０２について保持されている最小距離とを比較し、導出した距離の方が小さい値である場合、最小距離を、導出した距離に更新する。つまり、小領域４０２内に含まれる計測点のうち、測距センサ１３３または１３４までの距離が最も近い計測点と、その計測点が計測されたときの測距センサ１３３または１３４の位置との間の距離が最小距離として保持されることになる。

また、上部データ蓄積部１８０は、最小距離が更新された場合、その計測点から測距センサ１３３または１３４に向かうベクトルを導出し、導出したベクトルを計測方向ベクトルとして更新する。ここでは、最小距離となる計測点と、その計測点が測定されたときの測距センサ１３３または１３４の位置とのベクトルが計測方向ベクトルとして保持されることになる。

上部データ蓄積部１８０は、測距センサ１３３または１３４によって計測データが取得される度に、上部に属する全ての計測点について、対応する小領域４０２に統計データを蓄積していく。

同様に、下部データ蓄積部１８２は、測距センサ１３３および１３４により計測された計測点のうち、下部の計測点のトップフレーム座標系３１０の３次元位置を導出する。また、下部データ蓄積部１８２は、トップフレーム座標系３１０の３次元位置を、変換パラメータを用いてハッチコーミング座標系３２０の３次元位置に変換する。

そして、下部データ蓄積部１８２は、下部用の作業領域４００を用いて、ハッチコーミング座標系３２０における計測点の３次元位置に対応する小領域４０２に統計データを蓄積する下部計測データ蓄積処理を行う（図８のＳ１１０）。具体的には、下部データ蓄積部１８２は、対応する小領域４０２の投票回数（計測点の数）を１加算する。また、下部データ蓄積部１８２は、計測点のＸｃ軸方向の位置（座標）を、Ｘｃ軸方向の座標の総和に加算する。また、下部データ蓄積部１８２は、計測点のＹｃ軸方向の位置（座標）を、Ｙｃ軸方向の座標の総和に加算する。また、下部データ蓄積部１８２は、計測点のＺｃ軸方向の位置（座標）を、Ｚｃ軸方向の総和に加算する。

また、下部データ蓄積部１８２は、計測点と、その計測点が計測されたときの測距センサ１３３または１３４の位置との間の距離を導出する。そして、下部データ蓄積部１８２は、導出した距離と、その小領域４０２について蓄積されている最小距離とを比較し、導出した距離の方が小さい値である場合、最小距離を、導出した距離に更新する。なお、ここでは、ハッチコーミング座標系３２０に変換せずに、計測点と、その計測点を計測したときの測距センサ１３３または１３４の位置との間の距離を導出するようにしてもよい。

また、下部データ蓄積部１８２は、最小距離が更新された場合、その計測点から測距センサ１３３または１３４に向かうベクトルを導出し、導出したベクトルを計測方向ベクトルとして更新する。

下部データ蓄積部１８２は、アンローダ装置１００によって船庫５内の積荷６の掻き取り作業が終了する直前の数十分～数時間の間に、測距センサ１３３または１３４によって計測された計測データが取得される度に、下部に属する全ての計測点について、対応する小領域４０２に統計データを蓄積していく。このように、下部の作業領域４００に対しては、積荷６の掻き取り作業が終了する直前の数分間の間に取得された下部の計測点について統計データが蓄積される。これにより、積荷６が船庫５内にほとんど残っていないタイミングでの統計データが蓄積されることになる。したがって、下記で説明する船庫５の底面の形状を導出する際に、積荷６に対応する計測点をできる限り除外することができ、精度良く船庫５の底面の形状を導出することが可能となる。これにより、アンローダ装置１００によって同一の船庫５内の積荷６を２回目以降に荷揚げする際に、導出した船庫５の底面の形状を用いることで、作業者は船庫５の底面の形状を容易に把握することができる。

データ蓄積部１６０は、全ての計測が終了したかを判定する（Ｓ１１２）。ここでは、例えば、掻取部１１２が船庫５から取り除かれる程度の上昇を確認したかによって行われる。ただし、作業者が所定の操作を行うことで全ての計測が終了したかを判定するようにしてもよい。

そして、全ての計測が終了したと判定した場合（Ｓ１１２のＹＥＳ）、Ｓ１１４の処理に移る。一方、全ての計測が終了したと判定していない場合（Ｓ１１２のＮＯ）、Ｓ１０４の処理に移り、全ての計測が終了するまで、Ｓ１０４～Ｓ１１０の処理を繰り返し行う。

全ての計測が終了したと判定した場合（Ｓ１１２のＹＥＳ）、ノイズ除去部１６２は、ノイズ除去処理を行い（Ｓ１１４）、ノイズとされる小領域４０２に対して、船庫５の形状として抽出しないことを示す不採用フラグを立てる。ここで、ノイズ除去部１６２は、２つのノイズ除去処理を行う。

１つ目のノイズ除去処理では、ノイズ除去部１６２は、Ｚｃ軸方向の高さが同一（同一のＸｃＹｃ平面）の小領域４０２について、投票頻度が低い（計測点が少ない）小領域４０２に不採用フラグを立てる。具体的には、ノイズ除去部１６２は、Ｚｃ軸方向が同じ小領域４０２の全ての投票回数を積算する。そして、ノイズ除去部１６２は、Ｚｃ軸方向が同じ小領域４０２の投票回数が、積算された値の０．０１％未満である小領域４０２に不採用フラグを立てる。これにより、投票回数が極端に少ない小領域４０２が船庫５の形状として採用されることを抑制することができる。

２つ目のノイズ除去処理では、ノイズ除去部１６２は、１の小領域４０２に隣接する２６の小領域４０２（３×３×３＝２７のキューブにおける中央の小領域４０２以外の小領域４０２）について投票回数が０回であった場合、１の小領域４０２に不採用フラグを立てる。これは、雨やチリなどの浮遊物が計測点として計測された場合に、その小領域４０２が船庫５の形状として採用されることを防止するためである。

ノイズ除去部１６２によってノイズ除去処理が行われると、形状導出部１６４は、船庫５の３次元形状を導出する（図８のＳ１１６、Ｓ１１８）。底面形状導出部１９０は、主に下部用の作業領域４００（底面位置に所定の閾値を加算した高さ未満の小領域４０２）を用いて、船庫５の底面の３次元形状を導出する底面形状導出処理を行う（図８のＳ１１６）。側壁形状導出部１９２は、上部用の作業領域４００（下部用の作業領域４００における底面位置に所定の閾値を加算した高さ以上の小領域４０２を含む）を用いて、船庫５の側壁の３次元形状を導出する側壁形状導出処理を行う（図８のＳ１１８）。

図１５は、底面形状導出処理を説明する図である。なお、図１５では、計測点を黒丸で示し、抽出される小領域４０２を太線で示す。図１５に示すように、底面形状導出部１９０は、下部用の作業領域４００において、不採用フラグが立っていない小領域４０２の中から、Ｚｃ軸方向（上下方向）に並んだ小領域４０２のうち、Ｚｃ軸の値が最も小さい小領域４０２を抽出する。なお、小領域４０２において、統計データが一度も蓄積されていない場合、つまり、計測点が１個も含まれていない場合、その小領域４０２に対しては不採用フラグが立てられており、ここで抽出されることはない。

上記した下部計測データ蓄積処理では、船庫５内に積荷６が残っている状態での計測点についても各小領域４０２の統計データが蓄積される。このような場合、積荷６に対する計測点についても統計データに蓄積される。一方で、積荷６が減っていき、船庫５の底面が露出すると、船庫５の底面に対する計測点についての統計データが蓄積される。そこで、船庫５の底面が積荷６よりもＺｃ軸方向の下方に位置することを利用し、Ｚｃ軸方向に並んだ小領域４０２のうち、Ｚｃ軸の値が最も小さい小領域４０２を抽出することで、船庫５の底面に対応する小領域４０２を抽出することができる。

そして、底面形状導出部１９０は、抽出した小領域４０２のＺｃ軸方向の重心位置を代表高さとする。底面形状導出部１９０は、ＸｃＹｃ平面上の全ての位置の小領域４０２を抽出するとともに代表高さを導出する。そして、底面形状導出部１９０は、Ｚｃ軸方向に所定間隔（例えば、０．２～１ｍ）で範囲を区切り、区切られた範囲毎に、代表高さが含まれる小領域４０２の数を導出する。なお、Ｚｃ軸方向の間隔と、ＸｃＹｃ方向の間隔は、異なっていてもよい。

続いて、底面形状導出部１９０は、代表高さが含まれる小領域４０２の数が最も多い範囲と、最も多い数の５０％以上の数が導出された範囲とに含まれる小領域４０２の代表高さの平均を船庫５の底面の高さとして導出する。ここで、船庫５の底面は、Ｚｃ軸方向に常に一定ではなく、傾斜したり、一部が突出または窪んでいたりしている場合もある。そこで、代表高さが含まれる小領域４０２の数が最も多い範囲が底面の高さとして確からしいが、その数の５０％以上の数が導出される範囲も抽出することで、船庫５の平均的な底面の高さを導出することができる。

続いて、底面形状導出部１９０は、ＸｃＹｃ平面上で同一の小領域４０２毎に、船庫５の底面の高さにある小領域４０２と、その小領域４０２とＺｃ軸方向に隣接する小領域４０２との統計データを抽出する。そして、底面形状導出部１９０は、抽出した統計データについて項目ごとに加算し、３つの小領域４０２の重心位置を底面位置として導出する。ここでは、複数の小領域４０２に船庫５の底面が跨っている可能性があることを考慮し、Ｚｃ軸方向に隣接する小領域４０２についても抽出している。これにより、底面位置をより精度良く導出することができる。

底面形状導出部１９０は、ＸｃＹｃ平面上の全ての小領域４０２について、同様に、底面位置を導出する。これにより、底面形状導出部１９０は、複数の底面位置（重心位置）の点群により、船庫５の底面の形状（底部の形状）を導出したことになる。

図１６は、側壁に対応する小領域４０２を導出する様子を説明する図である。側壁形状導出部１９２は、上部用の作業領域４００の小領域４０２、および、下部用の作業領域４００における底面位置に所定の閾値を加算した高さ以上の小領域４０２のうち、不採用フラグが立っていない小領域４０２の中から、底面形状導出部１９０により導出された底面の高さに対して所定の値を加算したＺｃ軸方向の位置以上の小領域４０２を抽出する。

そして、側壁形状導出部１９２は、図１６に示すように、任意の１の小領域４０２（図中、中央の小領域４０２）のＸｃＹｃ平面上の周囲８個の小領域４０２を抽出する。そして、側壁形状導出部１９２は、８個の小領域４０２の中から、１の小領域４０２の計測方向ベクトルに対応する小領域４０２を比較対象小領域（図中、太線の小領域４０２）として抽出する。具体的には、側壁形状導出部１９２は、１の小領域４０２から８個の小領域４０２それぞれまでのベクトルのうち、計測方向ベクトルに最も近い（角度差が最も小さい）ベクトルに対応する小領域４０２を比較対象小領域として抽出する。その後、側壁形状導出部１９２は、１の小領域４０２の投票回数と、比較対象領域の投票回数とを比較する。また、側壁形状導出部１９２は、比較した結果、投票回数が少ない小領域４０２に対して不採用フラグを立てる。

側壁形状導出部１９２は、全ての小領域４０２に対して、同様に、比較対象領域の抽出、投票回数の比較、および、不採用フラグを立てる処理を実行する。

そして、側壁形状導出部１９２は、不採用フラグが立っていない、つまり、投票回数が多いと判定された小領域４０２の重心位置を側壁位置として導出する。換言すれば、側壁形状導出部１９２は、計測方向ベクトルに配列された小領域４０２間の統計データを比較して側壁（表面）に対応する小領域４０２を特定する。これにより、側壁形状導出部１９２は、複数の側壁位置（重心位置）の点群により、船庫５の側壁の形状（側部の形状）を導出したことになる。

ここで、計測方向ベクトルは、測距センサ１３３または１３４との距離が最小である計測点が計測されたときの方向を示すものである。したがって、計測方向ベクトルは、船庫５の中心方向を示すものであると言える。そして、計測方向ベクトルに沿った方向には、計測誤差によって計測点の数が異なる複数の小領域４０２が並ぶことになる。

そこで、１の小領域４０２と、計測方向に対応する比較対象小領域との投票回数を比較することで、側壁形状導出部１９２は、船庫５として最も確からしい位置の小領域４０２のみを残す（不採用フラグを立てない）ようにすることができる。これにより、側壁形状導出部１９２は、精度良く船庫５の側壁の形状を導出することができる。

形状導出部１６４は、船庫５の複数の底面位置（重心位置）の点群、および、複数の側壁位置（重心位置）の点群を導出すると、これら複数の底面位置（重心位置）の点群、および、複数の側壁位置（重心位置）の点群に基づいて、船庫５の３次元モデルを生成し、記憶部１４２に記憶する。なお、３次元モデルの生成方法は、例えば、底面位置および側壁位置それぞれを中心としたボクセルを配置することで３次元モデルを生成したり、隣接する底面位置および側壁位置を互いに結ぶ曲面を導き出すことで３次元モデルを生成したりしてもよく、その方法は問わない。

以上のように、アンローダ装置１００は、船庫５を基準とした作業領域４００を生成し、作業領域４００の小領域４０２に対して計測点の統計データを蓄積するようにした。これにより、アンローダ装置１００は、測距センサ１３３、１３４が船庫５に対して移動している場合であっても、常に船庫５を基準として統計データを蓄積することができる。かくして、アンローダ装置１００は、統計データの蓄積精度を高くすることができ、精度良く船庫５の３次元形状を導出することができる。

また、アンローダ装置１００は、同一の船庫５に対して積荷６の掻き取りを行う場合、船庫５の３次元モデルを表示部１４４に表示する。これにより、アンローダ装置１００では、船庫５の形状を作業者に容易に把握させることができる。

また、アンローダ装置１００は、測距センサ１３３、１３４で計測された計測点を上部と下部とに分けて統計データを蓄積していくようにした。また、アンローダ装置１００は、垂直方向に延在する船庫５の側壁の形状は上部の統計データを用いて導出し、水平方向に延在する船庫５の底面の形状は下部の統計データを用いて導出した。これにより、アンローダ装置１００は、船庫５の側壁および底面の形状をそれぞれ精度良く導出することができる。

図１７は、積荷６の表面高さを表示する処理の流れを示すフローチャートである。図１７に示すように、積荷６の表面高さを表示する処理を開始すると、まず、領域生成部１５２は、ハッチコーミング座標系３２０（図９、図１０参照）を基準とした（船庫５を基準とした）作業領域４００（図１１参照）を作成する領域作成処理を行う（Ｓ２００）。なお、ここでは、Ｓ１００と同一の処理が行われる。

積荷データ蓄積部１６６は、記憶部１４２に記憶された船庫５の３次元モデルを読み込む（Ｓ２０２）。ここでは、上記した船庫５の３次元形状を導出する処理において記憶部１４２に記憶された３次元モデルが読み出される。なお、船庫５の３次元モデルは、他の計測器により計測された計測データを用いて作成されてもよい。また、船庫５の３次元モデルは、ハッチコーミング７の図面に基づいて作成されてもよい。いずれにしても、船庫５の３次元モデルは、Ｓ２０２の処理が行われるまでに作成され、記憶部１４２に記憶されていればよい。なお、船庫５の３次元モデルは、読み出されなくてもよい。

続いて、計測データ取得部１５６は、測距センサ１３０～１３６で計測された計測点の計測データを随時取得する（Ｓ２０４）。なお、計測データ取得部１５６は、掻取部１１２が船庫５内の積荷６の掻き取り作業を開始してから、全ての積荷６を掻き取り終えるまでの間（例えば１０時間）、各測距センサ１３０～１３６から計測データを例えば１秒に２回～５回の頻度で定期的に取得する。

計測データ取得部１５６により計測点の計測データが取得されると、座標変換導出部１５８は、トップフレーム座標系３１０をハッチコーミング座標系３２０に変換するための変換パラメータを導出する座標変換処理を行う（Ｓ２０６）。なお、ここでは、図８で示した座標変換処理Ｓ１０６と同一の処理が行われる。

積荷データ蓄積部１６６は、測距センサ１３３および１３４により計測された計測点の３次元位置（計測データ）に基づいて、作業領域４００に形成された小領域４０２に対して計測点の統計データを蓄積していく（Ｓ２０８）。具体的には、積荷データ蓄積部１６６は、測距センサ１３３および１３４により計測された計測点のうち、下部の計測点のトップフレーム座標系３１０の３次元位置を導出する。また、積荷データ蓄積部１６６は、トップフレーム座標系３１０の３次元位置を、変換パラメータを用いてハッチコーミング座標系３２０の３次元位置に変換する。

そして、積荷データ蓄積部１６６は、ハッチコーミング座標系３２０における計測点の３次元位置に対応する小領域４０２に統計データを蓄積する。より詳細には、積荷データ蓄積部１６６は、対応する小領域４０２の投票回数（計測点の数）を１加算する。また、下部データ蓄積部１８２は、計測点のＸｃ軸方向の位置（座標）を、Ｘｃ軸方向の座標の総和に加算する。また、下部データ蓄積部１８２は、計測点のＹｃ軸方向の位置（座標）を、Ｙｃ軸方向の座標の総和に加算する。また、下部データ蓄積部１８２は、計測点のＺｃ軸方向の位置（座標）を、Ｚｃ軸方向の総和に加算する。

そして、所定期間（例えば５秒）に亘って積荷データ蓄積部１６６により小領域４０２に統計データが蓄積されると、ノイズ除去部１６２は、ノイズ除去処理を行い（Ｓ２１０）、ノイズとされる小領域４０２に対して、積荷６の表面形状として抽出しないことを示す不採用フラグを立てる。なお、ここでは、Ｓ１１４と同一の処理が行われる。

ノイズ除去部１６２によりノイズ除去処理が行われると、積荷高さ導出部１６８は、積荷６の表面高さを導出する積荷表面高さ導出処理を行う（Ｓ２１２）。

図１８は、積荷表面高さ導出処理Ｓ２１２を説明する図である。なお、図１８においては、図中左側に船庫５の積荷６の表面高さを示し、図中右側に同一のＸｃＹｃ平面上におけるＺｃ軸方向に並んだ小領域４０２を示す。また、図１８では、時刻Ｔ１での積荷６の表面高さを実線で示し、時刻Ｔ２での積荷６の表面高さを破線で示し、時刻Ｔ３での積荷６の表面高さを一点鎖線で示す。また、図１８では、時刻Ｔ１までに計測された計測点を黒丸で示し、時刻Ｔ１から時刻Ｔ２までに計測された計測点を白丸で示し、時刻Ｔ２から時刻Ｔ３までに計測された計測点を三角で示す。なお、時刻Ｔ２は、時刻Ｔ１よりも時間が経過している。また、時刻Ｔ３は、時刻Ｔ２よりも時間が経過している。

時刻Ｔ２における船庫５内の積荷６は、アンローダ装置１００によって掻き取られているため、時刻Ｔ１よりも少なくなっている。同様に、時刻Ｔ３における船庫５内の積荷６は、アンローダ装置１００によって掻き取られているため、時刻Ｔ２よりも少なくなっている。したがって、時刻Ｔ２における船庫５内の積荷６の表面高さは、時刻Ｔ１よりも低い。また、時刻Ｔ３における船庫５内の積荷６の表面高さは、時刻Ｔ２よりも低い。

一方、積荷データ蓄積部１６６は、掻取部１１２が船庫５内の積荷６の掻き取り作業を開始してから、小領域４０２（作業領域４００）に統計データを随時蓄積している。したがって、小領域４０２（作業領域４００）に蓄積される小領域の統計データは、時間が経過するほど増加する。時刻Ｔ１では、図１８中、黒丸で示す計測点の統計データが小領域４０２に蓄積される。時刻Ｔ２では、図１８中、黒丸および白丸で示す計測点の統計データが小領域４０２に蓄積される。時刻Ｔ３では、図１８中、黒丸、白丸および三角で示す計測点の統計データが蓄積される。

ここで、測距センサ１３３、１３４は、積荷６に向かってレーザーを発射しているため、積荷６の表面までの距離を計測することになる（積荷６の表面に計測点が存在することになる）。そして、アンローダ装置１００によって積荷６が掻き取られているため、積荷６の表面高さは、時間の経過とともに低下していく。したがって、測距センサ１３３、１３４により計測される計測点も、時間の経過とともにＺｃ軸方向の値が小さくなっていく。

そして、時刻Ｔ１、Ｔ２、Ｔ３において、計測点が蓄積されている小領域４０２のうち、Ｚｃ軸方向の値が最も小さい小領域４０２に対応する高さが、積荷６の表面高さとなる。

そこで、積荷高さ導出部１６８は、ＸｃＹｃ平面上が同一の小領域４０２毎に、不採用フラグが立っていない小領域４０２の中から、Ｚｃ軸方向（上下方向）に並んだ小領域４０２のうち、Ｚｃ軸方向の値が最も小さい小領域４０２を抽出する。なお、小領域４０２において、統計データが一度も蓄積されていない場合、つまり、計測点が１個も含まれていない場合、その小領域４０２に対しては不採用フラグが立てられており、ここで抽出されることはない。したがって、Ｚｃ軸方向の値が最も小さい小領域４０２が、その時点の積荷６の表面高さに相当する。

また、積荷高さ導出部１６８は、ＸｃＹｃ平面上が同一の小領域４０２毎に、抽出した小領域４０２と、その小領域４０２とＺｃ軸方向に隣接する小領域４０２との統計データを抽出する。そして、積荷高さ導出部１６８は、抽出した統計データについて項目ごとに加算し、３つの小領域４０２の重心位置を積荷高さとして導出する。ここでは、複数の小領域４０２に積荷６の表面が跨っている可能性があることを考慮し、Ｚｃ軸方向に隣接する小領域４０２についても抽出している。これにより、積荷６の表面高さをより精度良く導出することができる。

図１９は、積荷高さ表示画像５００の一例を説明する図である。積荷高さ導出部１６８により積荷高さが導出されると、表示制御部１７０は、図１９に示す積荷高さ表示画像５００を表示部１４４に表示する（Ｓ２１４）。

積荷高さ表示画像５００は、積荷高さ凡例画像５１０が左側に表示され、積荷高さ画像５２０が右側に表示される。なお、積荷高さ凡例画像５１０は、必須でない。また、積荷高さ凡例画像５１０の表示位置は、積荷高さ表示画像５００内において、どこに表示されていてもよい。

積荷高さ凡例画像５１０および積荷高さ画像５２０は、掻取部１１２の底面を基準にして、Ｘｃ軸方向における所定範囲ごとに異なる色で表示される。なお、図１９においては、異なる色をハッチングの密度によって表している。

表示制御部１７０は、積荷高さ導出部１６８により積荷高さが導出されると、ＸｃＹｃ平面上における各領域（小領域４０２に対応する領域）での、掻取部１１２の底面に対する積荷高さの相対距離を導出する。まず、表示制御部１７０は、エレベータ１１０および掻取部１１２の現在の位置および形状に基づいて、トップフレーム座標系３１０における掻取部１１２の底面のＸｃ軸方向の位置（高さ）を導出する。そして、表示制御部１７０は、トップフレーム座標系３１０における掻取部１１２の底面のＸｃ軸方向の位置（高さ）を、変換パラメータを用いてハッチコーミング座標系３２０に変換する。

また、表示制御部１７０は、ハッチコーミング座標系３２０における掻取部１１２の底面のＸｃ軸方向の位置から、各領域における積荷高さを減算することで、各領域における掻取部１１２の底面に対する積荷６の表面高さの相対距離を導出する。

そして、表示制御部１７０は、導出した相対距離に対応する範囲の色で、その領域を表した積荷高さ画像５２０を表示部１４４に表示する。また、表示制御部１７０は、掻取部１１２の３次元モデルを積荷高さ画像５２０内に重畳して表示する。

これにより、作業者は、積荷高さ表示画像５００を確認することで、船庫５内の積荷６の分布（状況）を容易に把握することができる。例えば、作業者は、積荷６が高い部分、つまり、掻き取るべき場所を容易に把握することができる。また、積荷６の表面高さを掻取部１１２の底面との相対距離で表示することにより、掻取部１１２の移動量など、アンローダ装置１００を操縦する際に必要となる情報を容易に確認させることができる。

また、測距センサ１３３、１３４は、掻取部１１２を中心に互いに反対側であって、水平より下向きに計測するように取り付けられる。これにより、進行方向の両側に測距センサ１３３、１３４が配置されることになり、掻き取り直後の積荷６の高さを直ぐに反映することができる。

以上、添付図面を参照しながら実施形態について説明したが、本開示はかかる実施形態に限定されないことは言うまでもない。当業者であれば、特許請求の範囲に記載された範疇において、各種の変更例または修正例に想到し得ることは明らかであり、それらについても当然に技術的範囲に属するものと了解される。

例えば、上記実施形態において、エッジ検出部１５４によるエッジの検出方法は一例に過ぎない。エッジ検出部１５４は、他の方法によりハッチコーミング７のエッジを抽出するようにしてもよい。

また、上記実施形態において、アンローダ装置１００の移動に伴って測距センサ１３３、１３４を移動させるようにしたが、測距センサ１３３、１３４の向き等を変更可能にしてもよい。これにより、測距センサ１３３、１３４の計測範囲を広くし、早期に船庫５の形状を導出することができる。

また、上記実施形態において、側壁の形状を導出する際、投票回数を比較するようにした。しかしながら、データ蓄積部１６０は、蓄積データとして計測時期を蓄積（更新）していくようにしてもよい。そして、形状導出部１６４は、より早い時期に計測された計測点が含まれる小領域４０２に不採用フラグを立て、より遅い時期に計測された計測点を残すようにしてもよい。これにより、例えば、積荷６が掻き取られていくなど、環境が変化する場合において、最も新しく計測された計測点を採用することで、物体の形状を精度良く導出することができる。

また、上記実施形態において、側壁の形状を導出する際、１の小領域４０２と、隣接する小領域４０２との投票回数を比較するようにした。しかしながら、１の小領域４０２と、計測方向ベクトルに対応する複数の小領域４０２との投票回数を比較するようにしてもよい。この場合、最も投票回数が多い小領域４０２のみを残し、他の小領域４０２に不採用フラグを立ててもよい。また、最も投票回数が多い小領域４０２、および、最も多い投票回数の所定の割合（例えば５０％）以上の投票回数がある小領域４０２を残すようにしてもよい。これにより、例えば、船庫５の側壁の近くに別の構造物がある場合、その構造物に対応する小領域４０２を残すことができる。

また、上記実施形態において、座標変換処理を毎回行うようにした。しかしながら、ＳＬＡＭ法を用いて、過去に計測された計測点と、今回計測された計測点とのマッチングを取ることにより、計測点のハッチコーミング座標系３２０の３次元位置を推定するようにしてもよい。

また、上記実施形態において、積荷６の表面高さを表示する処理では、１つの作業領域４００を用いて、測距センサ１３３、１３４で計測された計測点の計測データを小領域４０２に随時蓄積するようにした。しかしながら、複数の作業領域４００を用いて、測距センサ１３３、１３４で計測された計測点の計測データを、時間ごとに異なる作業領域４００を用いて蓄積するようにしてもよい。つまり、積荷データ蓄積部１６６は、測距センサ１３３、１３４で計測された所定時間の計測点の計測データを蓄積するようにしてもよい。例えば、積荷データ蓄積部１６６は、１時間ごとに統計データを蓄積する作業領域４００を変更すればよい。このとき、積荷データ蓄積部１６６は、統計データを蓄積する作業領域４００をオーバーラップさせるとよい。具体的には、１つ目の作業領域４００に統計データを蓄積し始めた後、３０分が経過すると、１つ目の作業領域４００と、２つ目の作業領域４００に統計データを蓄積する。そして、１時間が経過すると、２つ目の作業領域４００と、３つ目の作業領域４００に統計データを蓄積する。そして、表示制御部１７０は、３０分以上、統計データが蓄積された作業領域４００に基づいて、積荷高さ表示画像５００を表示部１４４に表示する。こうすることで、各作業領域４００の最下部(作業領域４００のうちＺｃ軸方向の値が最も小さい小領域４０２)は、時間経過とともに船庫５の底面側(Ｚｃ軸方向の負方向)に降下していく。

これにより、測距センサ１３３、１３４により計測された計測点の計測データのうち、直近の計測点の統計データに基づいて、積荷高さ表示画像５００を表示部１４４に表示することができる。そうすると、例えば、積荷６が船庫５内で崩れて積荷６の表面高さが高くなったとしても、積荷６の表面高さを精度良く表示することができる。

また、上記実施形態において、積荷６の表面高さを表示する処理では、測距センサ１３３、１３４で計測された計測点の計測データを小領域４０２に随時蓄積するようにした。しかしながら、計測点の計測データが取得された時間を記録しておき、予め設定された所定時間の経過に伴い、所定時間が経過した計測点の計測データを統計データから消去するようにしてもよい。これにより、測距センサ１３３、１３４により計測された計測点の計測データのうち、直近の計測点の統計データに基づいて、積荷高さ表示画像５００を表示部１４４に表示することができる。そうすると、例えば、積荷６が船庫５内で崩れて積荷６の表面高さが高くなったとしても、積荷６の表面高さを精度良く表示することができる。

また、上記実施形態において、積荷６の表面高さを表示する処理では、測距センサ１３３、１３４で計測された計測点の計測データを小領域４０２に蓄積するようにした。しかしながら、測距センサ１３３、１３４により計測された計測点の計測データのうち、図１４に示す方法と同様に平面Ｓ１より下の計測データのみを小領域４０２に蓄積するようにしてもよい。そうすることで、上側にせり出している壁面を計測したり、積荷６が計測されていない水平位置について、間違ってせり出している壁面の高さを表示したりすることを防ぐことができる。

また、上記実施形態において、領域生成部１５２が船庫５を基準として作業領域４００を生成するようにした。しかしながら、領域生成部１５２は、船舶４のいずれかの特定位置を基準として作業領域４００を生成するようにしてもよい。例えば、領域生成部１５２は、ハッチコーミング７およびハッチカバー８を含む開口部の特定位置を基準として作業領域４００を生成するようにしてもよい。これにより、同一の船舶４であっても、船首側、中央付近、船尾側で船庫５付近の構造は異なるため、構造に合わせて作業領域４００を生成することができる。

また、上記実施形態において、掻取部１１２を中心に互いに反対側となるよう、水平より下向きに計測するように２個の測距センサ１３３、１３４が取り付けられるようにした。しかしながら、測距センサは、掻取部１１２を中心に互いに反対側となるよう、水平より下向きに計測するように２個以上取り付けられるようにしてもよい。

また、上記実施形態において、荷揚げ装置の一例としてアンローダ装置１００を例に挙げて説明した。しかしながら、荷揚げ装置は、連続アンローダ(バケット式、ベルト式、垂直スクリューコンベア式など)、ニューマチックアンローダ等であってもよい。

本開示は、荷揚げ装置に利用することができる。

１００ アンローダ装置（荷揚げ装置）
１３３ 測距センサ
１３４ 測距センサ
１４４ 表示部
１５２ 領域生成部
１５６ 計測データ取得部
１６６ 積荷データ蓄積部
１６８ 積荷高さ導出部
１７０ 表示制御部
４００ 作業領域

Claims (8)

1. 船舶の特定位置を基準として、３次元に展開する複数の小領域で構成される作業領域を生成する領域生成部と、
   測距センサによって計測された船庫内の積荷の計測点における計測データを随時取得する計測データ取得部と、
   前記計測点の前記計測データに基づいて、前記計測点が含まれる小領域について、前記計測点の統計データを異なる複数の時刻にわたって蓄積する積荷データ蓄積部と、
   上下方向に並んで配置される複数の小領域のうち、前記統計データが蓄積されており、かつ、最も下方に位置する小領域を抽出し、抽出した小領域に基づいて前記船庫内の積荷の表面高さを導出する積荷高さ導出部と、
   を備える荷揚げ装置。
2. 前記積荷高さ導出部によって導出された前記積荷の表面高さを表示部に表示する表示制御部を備える請求項１に記載の荷揚げ装置。
3. 前記表示制御部は、
   前記積荷の表面高さを、前記積荷を掻き取る掻取部との相対高さで表示する請求項２に記載の荷揚げ装置。
4. 前記積荷データ蓄積部は、
   前記測距センサによって計測された所定時間の前記計測点の前記計測データを蓄積する請求項１から３のいずれか１項に記載の荷揚げ装置。
5. 前記領域生成部は、
   複数の前記作業領域を生成し、
   前記積荷データ蓄積部は、
   複数の前記作業領域のうち、時間ごとに異なる作業領域を用いて、前記統計データを蓄積する請求項１から４のいずれか１項に記載の荷揚げ装置。
6. 前記表示制御部は、
   前記特定位置に対する掻取部の位置を導出し、前記積荷の表面高さに前記掻取部の形状を重畳して表示する請求項２または３に記載の荷揚げ装置。
7. 前記測距センサは、
   掻取部を中心に互いに反対側であって、水平より下向きに計測するように２個以上取り付けられる請求項１から６のいずれか１項に記載の荷揚げ装置。
8. 前記領域生成部は、
   前記船舶の開口部を基準として、前記作業領域を生成する請求項１から７のいずれか１項に記載の荷揚げ装置。

Images