特開 2022-181762 作業支援装置、作業支援方法、および作業支援プログラム

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公開特許公報(A)

(11)【公開番号】P2022181762

(43)【公開日】2022-12-08

(54)【発明の名称】作業支援装置、作業支援方法、および作業支援プログラム

(51)【国際特許分類】

   B66B 7/00 20060101AFI20221201BHJP

【ＦＩ】

B66B7/00 J

【審査請求】未請求

【請求項の数】12

【出願形態】ＯＬ

(21)【出願番号】P 2021088903

(22)【出願日】2021-05-27

(71)【出願人】

【識別番号】000003078

【氏名又は名称】株式会社東芝

(74)【代理人】

【識別番号】110002147

【氏名又は名称】弁理士法人酒井国際特許事務所

(72)【発明者】

【氏名】肥後 亮佑

(72)【発明者】

【氏名】中本 秀一

(72)【発明者】

【氏名】石原 義之

【テーマコード（参考）】

3F305

【Ｆターム（参考）】

3F305AA21

3F305DA05

3F305DA09

3F305DA23

(57)【要約】

【課題】作業精度の向上を図る。
【解決手段】作業支援装置１０は、アーム機構１８と、第２判断部２２Ｄと、取得部２２Ｅと、導出部２２Ｆと、駆動制御部２２Ｇと、を備える。アーム機構１８は、作業空間内に配置された作業台に搭載され、端部にツール部の設けられた機構である。取得部２２Ｅは、作業空間における作業対象部およびツール部の撮影画像を取得する。導出部２２Ｆは、撮影画像に基づいて、作業対象部とツール部との相対位置を導出する。駆動制御部２２Ｇは、相対位置に基づいて、作業対象部の位置とツール部の位置とが一致するように、アーム機構１８の駆動部３０を制御する。
【選択図】図３

【特許請求の範囲】

【請求項1】

作業空間内に配置された作業台に搭載され、端部にツール部の設けられたアーム機構と、
前記作業空間における作業対象部および前記ツール部の撮影画像を取得する取得部と、
前記撮影画像に基づいて、前記作業対象部と前記ツール部との相対位置を導出する導出部と、
前記相対位置に基づいて、前記作業対象部の位置と前記ツール部の位置とが一致するように前記アーム機構の駆動部を制御する駆動制御部と、
を備える作業支援装置。

【請求項2】

前記駆動制御部は、
前記作業対象部と前記ツール部との距離に応じた速度で前記ツール部の位置を前記作業対象部の位置へ移動させるように前記駆動部を制御する、
請求項１に記載の作業支援装置。

【請求項3】

前記駆動制御部は、
前記距離が遠いほど速くかつ前記距離が近いほど遅い速度で、前記ツール部の位置を前記作業対象部の位置へ移動させるように前記駆動部を制御する、
請求項２に記載の作業支援装置。

【請求項4】

前記駆動制御部は、
前記作業対象部と前記ツール部との距離の変動に応じた速度で、前記ツール部の位置を前記作業対象部の位置へ移動させるように前記駆動部を制御する、
請求項２に記載の作業支援装置。

【請求項5】

前記アーム機構はジョイント部によって連結された１または複数のアーム部および前記ツール部からなり、
前記導出部は、
前記作業台の揺れ量に基づいて、前記作業対象部に対する前記作業台の移動量を更に導出し、
前記駆動制御部は、
導出した前記移動量を相殺するように前記ジョイント部の位置を更に制御する、
請求項１～請求項４の何れか１項に記載の作業支援装置。

【請求項6】

レーザ光を照射するレーザ照射部と、
レーザ照射可能か否かを判断する第１判断部と、
レーザ照射可能と判断された場合、前記作業対象部にレーザ光を照射するように前記レーザ照射部を制御するレーザ制御部と、
を備え、
前記導出部は、
レーザ照射可能と判断された場合、前記撮影画像に含まれる前記レーザ光のスポット領域を前記作業対象部として特定し、特定した前記作業対象部と前記ツール部との前記相対位置を導出する、
請求項１～請求項５の何れか１項に記載の作業支援装置。

【請求項7】

前記レーザ制御部は、
前記作業対象部がレーザ照射不可能と判断された場合、前記作業対象部から第１方向に第１距離離間した離間位置にレーザ光を照射するように前記レーザ照射部を制御し、
前記導出部は、
前記作業対象部がレーザ照射不可能と判断された場合、前記撮影画像に含まれる前記レーザ光のスポット領域から前記第１方向の反対方向に前記第１距離離間した領域を前記作業対象部として特定し、特定した前記作業対象部と前記ツール部との前記相対位置を導出する、
請求項６に記載の作業支援装置。

【請求項8】

レーザ照射不可能と判断された場合、テンプレートマッチング処理が可能か否かを判断する第２判断部を備え、
前記導出部は、
テンプレートマッチング処理が可能と判断された場合、前記撮影画像に含まれるテンプレート画像に一致または類似する領域を前記作業対象部として特定し、特定した前記作業対象部と前記ツール部との相対位置を導出する、
請求項１～請求項７の何れか１項に記載の作業支援装置。

【請求項9】

前記作業対象部から前記ツール部に加わる第１の力を検出する検出部を備え、
前記駆動制御部は、
前記第１の力を相殺するように前記駆動部を制御する、
請求項１～請求項８の何れか１項に記載の作業支援装置。

【請求項10】

前記作業空間は、
エレベータの昇降路である、
請求項１～請求項９の何れか１項に記載の作業支援装置。

【請求項11】

作業空間における作業対象部、および、前記作業空間内に配置された作業台に搭載され且つ端部にツール部の設けられたアーム機構における前記ツール部、の撮影画像を取得し、
前記撮影画像に基づいて、前記作業対象部と前記ツール部との相対位置を導出し、
前記相対位置に基づいて、前記作業対象部の位置と前記ツール部の位置とが一致するように前記アーム機構の駆動部を制御する、
作業支援方法。

【請求項12】

作業空間における作業対象部、および、前記作業空間内に配置された作業台に搭載され且つ端部にツール部の設けられたアーム機構における前記ツール部、の撮影画像を取得するステップと、
前記撮影画像に基づいて、前記作業対象部と前記ツール部との相対位置を導出するステップと、
前記相対位置に基づいて、前記作業対象部の位置と前記ツール部の位置とが一致するように前記アーム機構の駆動部を制御するステップと、
をコンピュータに実行させるための作業支援プログラム。

【発明の詳細な説明】

【技術分野】

【0001】

本発明の実施形態は、作業支援装置、作業支援方法、および作業支援プログラムに関する。

【背景技術】

【0002】

エレベータシャフトなどの作業空間内の作業を支援する装置が知られている。例えば、作業空間内の作業台に搭載されたロボット機構等によって作業支援を行うシステムが開示されている。また、作業空間の３Ｄモデルから穴やボルト等の作業対象部の位置を推定し、推定した位置に対する作業を支援するシステムが開示されている。また、壁面と工具との角度の検出結果を用いて工具の軸が壁面に対して垂直となるように工具の傾きを調整することで、壁面の作業対象部に対する作業を支援する技術が開示されている。

【先行技術文献】

【特許文献】

【0003】

【特許文献1】特開２０２０－７０９５号公報

【発明の概要】

【発明が解決しようとする課題】

【0004】

しかし、作業空間内に配置された作業台は作業空間内で揺れる場合がある。従来技術では、作業台の揺れ等により正確な位置合せが困難となり、作業精度が低下する場合があった。

【課題を解決するための手段】

【0005】

実施形態の作業支援装置は、アーム機構と、取得部と、導出部と、駆動制御部と、を備える。アーム機構は、作業空間内に配置された作業台に搭載され、端部にツール部が設けられている。取得部は、前記作業空間における作業対象部および前記ツール部の撮影画像を取得する。導出部は、前記撮影画像に基づいて、前記作業対象部と前記ツール部との相対位置を導出する。駆動制御部は、前記相対位置に基づいて、前記作業対象部の位置と前記ツール部の位置とが一致するように前記アーム機構の駆動部を制御する。

【図面の簡単な説明】

【0006】

【図1】作業支援システムの模式図。

【図2】作業支援装置の模式図。

【図3】作業支援装置の機能ブロック図。

【図4】撮影画像の模式図。

【図5】作業支援装置の模式図。

【図6】撮影画像の模式図。

【図7】テンプレート画像の模式図。

【図8】ボルト締め作業を示す模式図。

【図9A】作業台の揺れ量に応じた制御の説明図。

【図9B】作業台の揺れ量に応じた制御の説明図。

【図10】情報処理のフローチャート。

【図11】ハードウェア構成図。

【発明を実施するための形態】

【0007】

以下に添付図面を参照して、作業支援装置、作業支援方法、および作業支援プログラムを詳細に説明する。

【0008】

図１は、本実施形態の作業支援システム１の一例を示す模式図である。

【0009】

作業支援システム１は、作業空間２内で作業するユーザを支援するためのシステムである。

【0010】

作業空間２は、内側でユーザが作業可能な大きさの空間である。例えば、作業空間２は、エレベータの昇降路、車両等の物体が内側を移動するトンネル、下水道、等である。本実施形態では、作業空間２が、エレベータの昇降路である場合を一例として説明する。エレベータの昇降路は、エレベータシャフトと称される場合がある。

【0011】

作業空間２内には、作業空間２の延伸方向（矢印Ｚ’方向）に沿って移動するエレベータが配置され、該エレベータが延伸方向に沿って移動する。以下では、作業空間２の延伸方向を、延伸方向Ｚ’と称して説明する場合がある。本実施形態では、延伸方向Ｚ’が鉛直方向に一致する場合を一例として説明する。なお、延伸方向Ｚ’は、作業空間２の通路の延伸方向であればよく、鉛直方向に一致する形態に限定されない。

【0012】

本実施形態では、作業支援システム１のメンテナンス時などに、作業空間２内に作業台３を設置し、作業台３に乗ったユーザが作業空間２内で作業する場面を想定して説明する。

【0013】

作業台３は、メンテナンス時などに作業空間２内に配置され、作業空間２に対して取り外し可能に構成されている。作業空間２内に配置された作業台３は、ワイヤ４を介して、作業空間２の頂部に配置された変位部材５によって支持される。変位部材５によって、作業台３は、作業空間２内を延伸方向Ｚ’に移動可能とされている。すなわち、作業台３は、作業空間２内を移動する移動部材の一例である。なお、図１には、作業台３が２本のワイヤ４によって支持された形態を一例として示す。しかし、作業台３は、１本以上のワイヤ４によって支持されていればよく、２本に限定されない。

【0014】

作業台３は、通常のエレベータなどの組み立て時に利用されるゴンドラユニットに設置されてもよい。また、作業台３は、ゴンドラユニットであってもよい。また、作業台３は、作業支援システム１専用に用意されたユニットであってもよい。また、作業台３は、作業空間２を移動するエレベータかごに設置された構成であってもよい。また、作業台３は、エレベータかご、であってもよい。

【0015】

作業支援装置１０は、作業空間２内に配置された作業台３に設置されている。作業支援装置１０は、作業台３に設置されることで、作業空間２内を延伸方向Ｚ’に移動可能に配置された状態となる。

【0016】

図２は、作業支援装置１０の一例の模式図である。

【0017】

作業支援装置１０は、ロボット機構部１１と、レーザ照射部２０と、を備える。ロボット機構部１１とレーザ照射部２０とは通信可能に接続されている。

【0018】

ロボット機構部１１は、作業支援装置１０の本体部である。ロボット機構部１１は、作業台３に搭載されている。

【0019】

レーザ照射部２０はレーザ光Ｌを照射する。例えば、レーザ照射部２０は、作業空間２の内壁面に固定して設置されている。なお、レーザ照射部２０は、作業台３またはロボット機構部１１に搭載されていてもよい。しかし、照射精度向上の観点から、レーザ照射部２０は、作業空間２の内壁面に固定して設置されていることが好ましい。

【0020】

本実施形態では、レーザ照射部２０は、後述する制御部２２の制御によって作業対象５０の作業対象部Ｔにレーザ光Ｌを照射する。

【0021】

作業対象５０は、ロボット機構部１１によって作業される対象の部材である。作業対象５０は、例えば、作業空間２内の壁などの構造物である。作業対象部Ｔは、作業対象５０における作業対象の領域または作業対象の物である。作業対象部Ｔは、例えば、作業対象５０における穴または孔を設ける対象となる領域、作業対象５０に取り付けるネジやボルトなどの部材などである。図２には、作業対象部Ｔが穴あけ対象の領域Ｔ１である形態を一例として示す。

【0022】

ロボット機構部１１は、撮影部１２と、距離センサ１４と、力センサ１６と、アーム機構１８と、制御部２２と、揺れ量センサ２４と、を備える。

【0023】

アーム機構１８は、ツール部１８Ａを保持するためのアシスト機構である。言い換えると、アーム機構１８は、ツール部１８Ａのハンドリングを支援するための機構である。アーム機構１８は作業台３に搭載されている。本実施形態では、アーム機構１８は、支持台２３を介して作業台３に設置されている。

【0024】

ツール部１８Ａは、作業空間２の作業時に用いられる部材である。ツール部１８Ａは、アーム機構１８の延伸方向の端部に設けられている。ツール部１８Ａは、例えば、電動ドリル、インパクトドライバ、等の各種の道具または工具や、ブラケット、ガイドレール、カウンターウェイト、および部品などを取り付けるための各種の取付け部材、などである。図１には、ツール部１８Ａが電動ドリル１８Ａ１である形態を一例として示す。

【0025】

アーム機構１８は、例えば、ツール部１８Ａと、アーム部１８Ｂと、アーム部１８Ｃと、アーム部１８Ｄと、を備える。ツール部１８Ａおよびこれらの複数のアーム部（１８Ｂ、１８Ｃ、１８Ｄ）は、１または複数のジョイント部１９によって連結されてなる。本実施形態では、ツール部１８Ａとアーム部１８Ｂとはジョイント部１９Ａによって連結されている。また、アーム部１８Ｂとアーム部１８Ｃとはジョイント部１９Ｂによって連結されている。また、アーム部１８Ｃとアーム部１８Ｄとはジョイント部１９Ｃによって連結されている。

【0026】

ジョイント部１９には駆動部３０が設けられている。駆動部３０の駆動によってジョイント部１９が駆動されることで、ジョイント部１９の各々の位置、アーム機構１８のツール部１８Ａの位置、およびアーム機構１８の姿勢が調整される。

【0027】

ジョイント部１９Ａには、撮影部１２、距離センサ１４、および力センサ１６が設けられている。

【0028】

撮影部１２は、撮影によって撮影画像データを取得する。以下では、撮影画像データを、撮影画像と称して説明する。本実施形態では、撮影部１２は、ツール部１８Ａおよび作業対象部Ｔの撮影画像を取得する。撮影部１２は、ツール部１８Ａおよび作業対象部Ｔの撮影画像を取得可能な位置に設けられていればよく、ジョイント部１９Ａに設けられた形態に限定されない。また、作業支援装置１０は、複数の撮影部１２を備えた構成であってもよい。この場合、複数の撮影部１２によってツール部１８Ａおよび作業対象部Ｔの撮影画像を撮影すればよい。

【0029】

距離センサ１４は、ツール部１８Ａと作業対象５０との距離を計測するためのセンサである。詳細には、距離センサ１４は、ツール部１８Ａの先端部と作業対象５０との最短距離を計測する。距離センサ１４には、距離を計測可能な公知のセンサを用いればよい。距離センサ１４は、ツール部１８Ａと作業対象５０との距離を計測可能な位置に配置されていればよく、ジョイント部１９Ａに設けられた形態に限定されない。

【0030】

力センサ１６は、ツール部１８Ａの外部からツール部１８Ａに加わる力を検出するセンサである。本実施形態では、力センサ１６は、作業対象部Ｔからツール部１８Ａに加わる力を検出する。作業対象部Ｔからツール部１８Ａに加わる力は、第１の力に相当する。力センサ１６は、第１の力を検出する検出部の一例である。力センサ１６は、ツール部１８Ａの外部からツール部１８Ａに加わる力を検出可能な公知のセンサであればよい。また、力センサ１６は、ツール部１８Ａの外部からツール部１８Ａに加わる力を検出可能な位置に配置されていればよく、ジョイント部１９Ａに設けられた形態に限定されない。

【0031】

揺れ量センサ２４は、作業台３の揺れ量を検出するセンサである。揺れ量センサ２４は、作業台３に設けられている。揺れ量センサ２４は、例えば、加速度センサ、ジャイロセンサなどである。

【0032】

制御部２２は、ロボット機構部１１を制御する。制御部２２の詳細は後述する。

【0033】

図３は、本実施形態の作業支援装置１０の一例の機能ブロック図である。

【0034】

作業支援装置１０は、ロボット機構部１１と、レーザ照射部２０と、を備える。ロボット機構部１１とレーザ照射部２０とは通信可能に接続されている。

【0035】

レーザ照射部２０は、レーザ照射器２０Ａと、通信部２０Ｂと、制御部２０Ｃと、を備える。レーザ照射器２０Ａおよび通信部２０Ｂと、制御部２０Ｃとは、通信可能に接続されている。

【0036】

レーザ照射器２０Ａは、レーザ光Ｌを照射する装置である。レーザ照射器２０Ａは、例えば、レーザポインティングデバイス、プロジェクタなどであるが、これらに限定されない。レーザポインティングデバイスは、例えば、レーザ墨出し器などである。

【0037】

通信部２０Ｂは、ロボット機構部１１や他の情報処理装置と通信する通信機能部である。

【0038】

制御部２０Ｃは、作業内容に応じた設計情報によって規定される作業位置にレーザ光Ｌを照射するように、レーザ照射器２０Ａを制御する。この制御により、制御部２０Ｃは、レーザ照射器２０Ａから作業対象部Ｔへレーザ光Ｌを照射させる。制御部２０Ｃは、例えば、ロボット機構部１１から通信部２０Ｂを介して設計情報を取得する。設計情報の詳細は後述する。制御部２０Ｃは、サーバ装置などの情報処理装置から通信部２０Ｂを介して設計情報を取得してもよい。

【0039】

次にロボット機構部１１について説明する。

【0040】

ロボット機構部１１は、撮影部１２と、距離センサ１４と、力センサ１６と、アーム機構１８と、制御部２２と、揺れ量センサ２４と、通信部２６と、記憶部２８と、駆動部３０と、ＵＩ（ユーザ・インターフェース）部３２と、を備える。

【0041】

撮影部１２、距離センサ１４、力センサ１６、揺れ量センサ２４、通信部２６、記憶部２８、駆動部３０、および制御部２２は、バスなどを介して通信可能に接続されている。

【0042】

通信部２６は、レーザ照射部２０や他の情報処理装置と通信する通信機能部である。

【0043】

記憶部２８は、各種の情報を記憶する。記憶部２８は、例えば、管理情報を記憶する。管理情報は、作業を管理するための情報である。例えば、管理情報は、１または複数の作業内容ごとに、作業対象部Ｔの位置を規定した情報である。詳細には、例えば、管理情報は、作業ＩＤと、設計情報と、を対応付けた情報である。

【0044】

作業ＩＤは、作業の識別情報である。例えば、作業ＩＤは、作業順を表す番号などで表される。設計情報は、対応する作業ＩＤによって識別される作業に関する情報である。

【0045】

設計情報は、例えば、作業位置情報と、作業対象部情報と、作業内容情報と、を含む。

【0046】

作業位置情報は、対応する作業ＩＤによって識別される作業の作業位置を示す情報である。言い換えると、作業位置情報は、作業対象部Ｔの位置を示す情報である。

【0047】

作業対象部情報は、作業対象部Ｔを示す情報である。例えば、作業対象部情報は、作業対象部Ｔの種類、作業対象部Ｔの形状、レーザ光Ｌによる反射の有無、などを示す情報である。

【0048】

作業対象部Ｔの種類は、例えば、穴あけ対象の領域Ｔ１、ボルトＴ２などの作業対象部Ｔの種類を表す情報である。レーザ光Ｌによる反射有無を示す情報は、反射有または反射無を表す情報である。反射有とは、作業対象部Ｔにレーザ光Ｌが照射されると作業対象部Ｔの反射により作業対象部Ｔが撮影部１２で撮影されないことを表す。反射無とは、作業対象部Ｔにレーザ光Ｌが照射されても作業対象部Ｔが撮影部１２で撮影されることを表す。作業内容情報は、作業対象部Ｔに対する作業内容を表す情報である。作業内容情報は、例えば、作業対象部Ｔである穴あけ対象の領域Ｔ１への穴あけ、作業対象部ＴであるボルトＴ２のボルト締め、などを表す情報である。

【0049】

記憶部２８は、通信部２６を介して外部の情報処理装置などから受信した管理情報を記憶すればよい。

【0050】

記憶部２８は、例えば、ＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）、フラッシュメモリ等の半導体メモリ素子、ハードディスク、光ディスク等である。なお、記憶部２８は、ロボット機構部１１または作業支援装置１０の外部に設けられた記憶装置であってもよい。

【0051】

ＵＩ部３２は、ユーザによる操作入力を受付ける機能、および、各種の情報を出力する機能を備える。例えば、ＵＩ部３２は、ディスプレイ３２Ａと、入力部３２Ｂと、を含む。

【0052】

ディスプレイ３２Ａは、各種の情報を表示する。ディスプレイ３２Ａは、例えば、公知の有機ＥＬ（Ｅｌｅｃｔｒｏ－Ｌｕｍｉｎｅｓｃｅｎｃｅ）ディスプレイ、ＬＣＤ（Ｌｉｑｕｉｄ Ｃｒｙｓｔａｌ Ｄｉｓｐｌａｙなどである。入力部３２Ｂは、ユーザからの各種指示を受付ける。入力部３２Ｂは、例えば、キーボード、マウス、タッチパネル、マイクロフォン、などである。

【0053】

制御部２２は、専用または汎用コンピュータである。

【0054】

記憶部２８および制御部２２の少なくとも一方を、ネットワークを介して通信部２６に接続されたサーバ装置などの情報処理装置に搭載した構成としてもよい。また、制御部２２に含まれる後述する機能部の少なくとも１つを、ネットワークおよび通信部２６を介して制御部２２に接続されたサーバ装置などの情報処理装置に搭載してもよい。

【0055】

制御部２２は、情報処理を実行する。制御部２２は、受付部２２Ａと、第１判断部２２Ｂと、レーザ制御部２２Ｃと、第２判断部２２Ｄと、取得部２２Ｅと、導出部２２Ｆと、駆動制御部２２Ｇと、を備える。

【0056】

受付部２２Ａ、第１判断部２２Ｂ、レーザ制御部２２Ｃ、第２判断部２２Ｄ、取得部２２Ｅ、導出部２２Ｆ、および駆動制御部２２Ｇの少なくとも１つは、例えば、１または複数のプロセッサにより実現される。例えば、上記各部は、ＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）などのプロセッサにプログラムを実行させること、すなわちソフトウェアにより実現してもよい。上記各部は、専用のＩＣ（Ｉｎｔｅｇｒａｔｅｄ Ｃｉｒｃｕｉｔ）などのプロセッサ、すなわちハードウェアにより実現してもよい。上記各部は、ソフトウェアおよびハードウェアを併用して実現してもよい。複数のプロセッサを用いる場合、各プロセッサは、各部のうち１つを実現してもよいし、各部のうち２以上を実現してもよい。

【0057】

受付部２２Ａは、ＵＩ部３２から作業ＩＤを受付ける。ユーザは、作業開始時にＵＩ部３２を操作することで、管理情報に含まれる所望の作業ＩＤを選択する。受付部２２Ａは、ユーザによって選択された作業ＩＤを受付ける。

【0058】

第１判断部２２Ｂは、レーザ照射可能か否かを判断する。レーザ照射可能か否を判断するとは、レーザ光Ｌを作業対象部Ｔに照射可能であるか否かを判断することを意味する。例えば、第１判断部２２Ｂは、受付部２２Ａで受付けた作業ＩＤに対応する設計情報に含まれる、レーザ光Ｌによる反射の有無を表す情報を用いて、レーザ照射可能か否かを判断する。詳細には、第１判断部２２Ｂは、作業対象部情報に含まれるレーザ光Ｌによる反射の有無を表す情報が、反射有を示す場合、レーザ照射不可能と判断する。また、第１判断部２２Ｂは、作業対象部情報に含まれるレーザ光Ｌによる反射の有無を表す情報が、反射無を示す場合、レーザ照射可能と判断する。

【0059】

なお、第１判断部２２Ｂは、作業対象部Ｔの素材に基づいてレーザ照射可能か否かを判断してもよい。この場合、管理情報は、作業対象物情報として、作業対象部Ｔの素材を表す素材情報を更に登録した構成とすればよい。第１判断部２２Ｂは、作業ＩＤに対応する素材情報が、レーザ光Ｌにより反射する素材であるか否かを判別することで、レーザ照射可能か否を判断してもよい。

【0060】

また、第１判断部２２Ｂは、レーザ照射器２０Ａの故障を判別した場合、レーザ照射不可能と判断してもよい。また、第１判断部２２Ｂは、レーザ照射器２０Ａの正常動作を判別した場合、レーザ照射可能と判断してもよい。

【0061】

レーザ制御部２２Ｃは、レーザ照射可能と判断された場合、作業対象部Ｔにレーザ光Ｌを照射するようにレーザ照射部２０を制御する。例えば、レーザ制御部２２Ｃは、管理情報における作業ＩＤに対応する設計情報に含まれる作業位置情報を特定する。そして、レーザ制御部２２Ｃは、特定した作業位置情報、およびレーザ照射開始を表す情報を、通信部２６を介してレーザ照射部２０へ出力する。レーザ照射部２０の制御部２０Ｃは、ロボット機構部１１から通信部２０Ｂを介してレーザ照射開始を表す情報を受付けると、受付けた作業位置情報によって表される作業位置へレーザ光Ｌを照射するようにレーザ照射器２０Ａを制御する。このため、レーザ制御部２２Ｃの制御によって、レーザ照射部２０のレーザ照射器２０Ａから作業対象部Ｔの作業位置へレーザ光Ｌが照射される。

【0062】

具体的には、図２に示すように、レーザ照射部２０から作業対象部Ｔの位置である作業位置へレーザ光Ｌ１が照射される。レーザ光Ｌ１は、作業対象部Ｔに照射されるレーザ光Ｌの一例である。レーザ光Ｌ１が照射されることで、作業対象５０の作業位置にはレーザ光Ｌ１によるスポット領域Ｐ１が形成される。スポット領域Ｐ１は、スポット領域Ｐの一例である。スポット領域Ｐは、作業対象５０におけるレーザ光Ｌの照射された領域である。

【0063】

図３に戻り説明を続ける。

【0064】

第２判断部２２Ｄは、第１判断部２２Ｂによってレーザ照射不可能と判断された場合、テンプレートマッチング処理が可能か否かを判断する。テンプレートマッチング処理とは、撮影画像からテンプレート画像を探索することで、撮影画像に含まれる作業対象部Ｔを特定する処理を表す。

【0065】

第２判断部２２Ｄは、例えば、撮影部１２から撮影画像を取得する。そして、第２判断部２２Ｄは、取得した撮影画像に作業対象部Ｔが存在するか否かを判別することで、テンプレートマッチング処理が可能であるか否かを判断する。詳細には、第２判断部２２Ｄは、受付部２２Ａで受付けた作業ＩＤに対応する設計情報に含まれる作業対象部情報によって特定される作業対象部Ｔが撮影画像に存在するか否かを、公知の画像処理などにより判別すればよい。

【0066】

取得部２２Ｅは、作業空間２における作業対象部Ｔおよびツール部１８Ａの撮影画像を取得する。例えば、制御部２２は、駆動部３０を駆動することで、選択を受付けた作業ＩＤに対応する作業位置情報によって表される作業位置の近傍に、アーム機構１８のツール部１８Ａを移動させる。制御部２２は、作業位置情報および距離センサ１４の検出結果に基づいて駆動部３０を制御することで、撮影部１２で作業対象部Ｔを撮影可能な位置にアーム機構１８を移動させる。取得部２２Ｅは、作業対象部Ｔを撮影可能な位置にアーム機構１８が移動された状態で撮影部１２によって撮影された撮影画像を取得する。

【0067】

図４は、撮影画像４０の一例の模式図である。撮影画像４０は、第１判断部２２Ｂによってレーザ照射可能と判断され、レーザ制御部２２Ｃによって作業対象部Ｔにレーザ光Ｌが照射された状態で撮影された撮影画像の一例である。

【0068】

図４に示すように、撮影画像４０には、ツール部１８Ａおよびスポット領域Ｐ１が含まれる。図４には、ツール部１８Ａとして電動ドリル１８Ａ１が撮影された状態を示す。スポット領域Ｐ１は、作業対象部Ｔにレーザ光Ｌ１が照射されることで作業対象５０に形成されたレーザ光Ｌ１のスポット領域Ｐである。

【0069】

導出部２２Ｆは、撮影画像に基づいて、作業対象部Ｔとツール部１８Ａとの相対位置を導出する。

【0070】

取得部２２Ｅによって撮影画像４０が取得された場合を想定する。すなわち、第１判断部２２Ｂによってレーザ照射可能と判断され、レーザ制御部２２Ｃによって作業対象部Ｔにレーザ光Ｌが照射された状態で撮影された撮影画像を取得した場合を想定する。この場合、導出部２２Ｆは、撮影画像４０に含まれるレーザ光Ｌ１のスポット領域Ｐ１を、作業対象部Ｔとして特定する。そして、導出部２２Ｆは、特定したスポット領域Ｐ１とツール部１８Ａとの相対位置を導出する。

【0071】

詳細には、導出部２２Ｆは、撮影画像４０におけるスポット領域Ｐ１の位置（Ｘｒ、Ｙｒ）を特定する。また、導出部２２Ｆは、撮影画像４０におけるツール部１８Ａの位置（Ｘｔ、Ｙｔ）を特定する。導出部２２Ｆは、撮影画像４０におけるツール部１８Ａの先端の位置をツール部１８Ａの位置として特定する。そして、導出部２２Ｆは、これらの位置（Ｘｒ、Ｙｒ）および位置（Ｘｔ、Ｙｔ）を特定することで、スポット領域Ｐ１とツール部１８Ａとの相対位置を特定する。

【0072】

なお、レーザ制御部２２Ｃは、作業対象部Ｔがレーザ照射不可能と判断された場合、作業対象部Ｔから第１方向に第１距離離間した離間位置にレーザ光Ｌを照射するようにレーザ照射部２０を制御してもよい。

【0073】

図２を用いて説明する。この場合、レーザ制御部２２Ｃは、作業対象部Ｔの位置であるスポット領域Ｐ１から第１方向Ｚ１に第１距離Ｅ離間した位置に、レーザ光Ｌ２を照射するようにレーザ照射部２０を制御する。詳細には、レーザ制御部２２Ｃは、管理情報における受付部２２Ａで受付けた作業ＩＤに対応する作業位置情報を特定する。そして、レーザ制御部２２Ｃは、特定した作業位置情報によって表される作業位置から、第１方向Ｚ１に第１距離Ｅ離間した位置を表す情報を、新たな作業位置情報としてレーザ照射部２０へ送信すればよい。レーザ照射部２０は、受付けた作業位置情報に基づいて、作業対象部Ｔの位置であるスポット領域Ｐ１から第１方向Ｚ１に第１距離Ｅ離間した位置に、レーザ光Ｌ２を照射する。このため、作業対象５０には、スポット領域Ｐ１から第１方向Ｚ１に第１距離Ｅ離間した位置に、レーザ光Ｌ２によるスポット領域Ｐ２が形成される。

【0074】

この場合、導出部２２Ｆは、撮影画像４０に含まれるレーザ光Ｌ２のスポット領域Ｐ２から該第１方向Ｚ１の反対方向に第１距離Ｅ離間した領域を、作業対象部Ｔとして特定すればよい。詳細には、導出部２２Ｆは、撮影画像４０に含まれるレーザ光Ｌ２のスポット領域Ｐ２から該第１方向Ｚ１の反対方向に第１距離Ｅ離間した領域を、作業対象部Ｔの位置として特定する。そして、導出部２２Ｆは、特定した作業対象部Ｔとツール部１８Ａとの相対位置を、上記と同様にして特定すればよい。すなわち、導出部２２Ｆは、作業対象部Ｔの位置（Ｘｒ，Ｙｒ）と、アーム機構１８の位置（Ｘｔ，Ｙｔ）と、を導出すればよい。

【0075】

図３に戻り説明を続ける。一方、第１判断部２２Ｂによってレーザ照射不可能と判断され、且つ、第２判断部２２Ｄによってテンプレートマッチング処理可能と判断された場合を想定する。

【0076】

例えば、以下の場合、レーザ照射不可能と判断され、且つ、テンプレートマッチング処理可能と判断される。

【0077】

図５は、作業支援装置１０の他の一例の模式図である。図５に示す作業支援装置１０は、ツール部１８Ａとして、電動ドリル１８Ａ１に替えてインパクトドライバ１８Ａ２を備える。また、図５には、作業対象部Ｔが、穴あけ対象の領域Ｔ１に替えてボルトＴ２である形態を示す。ボルトＴ２は、例えば、作業対象５０Ａと作業対象５０Ｂの各々から突出して設けられた部材５０Ｃを連結するボルトである。作業対象５０Ａ、作業対象５０Ｂ、および部材５０Ｃは、作業対象５０の一例である。

【0078】

なお、図５に示す作業支援装置１０は、作業対象５０として作業対象５０Ａ、作業対象５０Ｂ、および部材５０Ｃを更に備え、電動ドリル１８Ａ１に替えてインパクトドライバ１８Ａ２、穴あけ対象の領域Ｔ１に替えてボルトＴ２を用いる点以外は、図２に示す作業支援装置１０と同様の構成である。

【0079】

図５に示すように、作業対象部ＴがボルトＴ２である場合には、反射によってボルトＴ２が撮影されない場合がある。このため、ボルトＴ２に対する作業に関する設計情報には、作業対象部情報として、レーザ光Ｌによる反射有を示す情報が予め登録されている。このため、この場合、第１判断部２２Ｂは、レーザ照射不可能と判断する。また、第２判断部２２Ｄは、取得した撮影画像に作業対象部ＴであるボルトＴ２が存在することを判別する処理などにより、テンプレートマッチング処理が可能であると判断する。

【0080】

この場合、取得部２２Ｅによって取得される撮影画像には、ボルトＴ２およびインパクトドライバ１８Ａ２が、作業対象部Ｔおよびツール部１８Ａとして含まれることとなる。

【0081】

図６は、撮影画像４２の一例を示す模式図である。撮影画像４２は、第１判断部２２Ｂによってレーザ照射不可能と判断され、第２判断部２２Ｄによってテンプレートマッチング処理可能と判断されたときに、撮影部１２によって撮影される撮影画像の一例である。

【0082】

図６に示すように、撮影画像４２には、ツール部１８Ａと作業対象部Ｔが含まれる。図６には、ツール部１８Ａとしてインパクトドライバ１８Ａ２が撮影され、作業対象部ＴとしてボルトＴ２が撮影された状態を示す。

【0083】

この場合、導出部２２Ｆは、撮影画像４２に含まれるテンプレート画像に一致または類似する領域を、作業対象部Ｔとして特定する。

【0084】

図７は、テンプレート画像４４の一例を示す模式図である。テンプレート画像４４は、例えば、作業ＩＤに対応する設計情報に、作業対象部Ｔの形状を表す情報として予め登録されている。導出部２２Ｆは、撮影画像４０からテンプレート画像４４を探索することで、テンプレート画像４４に一致または類似する領域を、ボルトＴ２として特定する。詳細には、導出部２２Ｆは、撮影画像４０における、テンプレート画像４４の特徴量に一致または類似する領域を、ボルトＴ２として特定する。特徴量には、任意のものを用いればよい。

【0085】

そして、導出部２２Ｆは、特定した作業対象部Ｔとツール部１８Ａとの相対位置を、上記と同様にして導出すればよい。すなわち、導出部２２Ｆは、撮影画像４２における、ボルトＴ２の位置（Ｘｒ，Ｙｒ）およびインパクトドライバ１８Ａ２の位置（Ｘｔ，Ｙｔ）を導出する。

【0086】

図３に戻り説明を続ける。駆動制御部２２Ｇは、導出部２２Ｆで導出された作業対象部Ｔとツール部１８Ａとの相対位置に基づいて、作業対象部Ｔの位置とツール部１８Ａの位置とが一致するように、アーム機構１８の駆動部３０を制御する。

【0087】

詳細には、駆動制御部２２Ｇは、ツール部１８Ａの位置が作業対象部Ｔの位置に一致するように駆動部３０を制御することで、アーム機構１８のジョイント部１９の各々の位置を制御する。駆動制御部２２Ｇは、時刻の各々に対するジョイント部１９の各々の目標位置を導出し、各時刻にジョイント部１９の各々が導出した目標位置に位置するように駆動部３０を制御する。これらの制御により、駆動制御部２２Ｇは、作業対象部Ｔの位置とツール部１８Ａの位置とが一致するように、アーム機構１８の駆動部３０を制御する。

【0088】

図４を用いて説明する。例えば、導出部２２Ｆによって、作業対象部Ｔの位置（Ｘｒ，Ｙｒ）と、ツール部１８Ａの位置（Ｘｔ，Ｙｔ）と、が相対位置として導出された場合を想定する。

【0089】

この場合、駆動制御部２２Ｇは、作業対象部Ｔの位置（Ｘｒ，Ｙｒ）が、ツール部１８Ａの位置（Ｘｔ，Ｙｔ）に一致するように、アーム機構１８の駆動部３０を制御する。このため、駆動制御部２２Ｇの駆動制御によって、ツール部１８Ａの先端の位置が作業対象部Ｔの位置へと移動する。

【0090】

そして、ツール部１８Ａの先端の位置が作業対象部Ｔの位置へと到達すると、駆動制御部２２Ｇは、ツール部１８Ａを作業対象部Ｔへと近づける。駆動制御部２２Ｇは、距離センサ１４による距離の検出結果を用いて、ツール部１８Ａと作業対象部Ｔへ近づければよい。そして、駆動制御部２２Ｇは、受付部２２Ａで受付けた作業ＩＤに対応する作業内容情報によって表される作業内容を実行するようにツール部１８Ａを制御すればよい。例えば、作業内容が穴あけ対象の領域Ｔ１への穴あけである場合を想定する。この場合、駆動制御部２２Ｇは、作業対象５０の穴あけ対象の領域Ｔ１へ、作業対象５０に対して垂直に穴開け処理を実行するように、電動ドリル１８Ａ１を駆動制御すればよい。また、作業内容がボルトＴ２のボルト締めである場合を想定する。この場合、駆動制御部２２Ｇは、ボルトＴ２のボルト締め処理を実行するようにボルトＴ２を駆動制御すればよい。

【0091】

なお、駆動制御部２２Ｇは、作業対象部Ｔの位置（Ｘｒ，Ｙｒ）がツール部１８Ａの位置（Ｘｔ，Ｙｔ）に一致するようにアーム機構１８の駆動部３０を制御する際に、以下の速度制御処理を更に実行することが好ましい。

【0092】

図４を用いて説明する。駆動制御部２２Ｇは、ツール部１８Ａが位置（Ｘｔ，Ｙｔ）から作業対象部Ｔの位置（Ｘｒ，Ｙｒ）に向かって所定速度で移動するように、駆動部３０に対して速度制御処理を実行することが好ましい。

【0093】

具体的には、駆動制御部２２Ｇは、作業対象部Ｔとツール部１８Ａとの距離に応じた速度で、ツール部１８Ａの位置を作業対象部Ｔの位置へ移動させるように駆動部３０を制御する。

【0094】

詳細には、駆動制御部２２Ｇは、作業対象部Ｔとツール部１８Ａとの距離が遠いほど速くかつ該距離が近いほど遅い速度で、ツール部１８Ａの位置を作業対象部Ｔの位置へ移動させるように駆動部３０を制御する。

【0095】

すなわち、駆動制御部２２Ｇは、下記式（１）および式（２）を満たす速度（Ｖｘ，Ｖｙ）で移動するように駆動部３０を制御する。

【0096】

【数1】

【0097】

式（１）中、Ｖｘは、撮影画像におけるＸ軸方向の移動速度である。式（２）中、Ｖｙは、撮影画像におけるＹ軸方向の移動速度である。Ｋは、制御ゲインであり、任意の値を設定してよい。

【0098】

駆動制御部２２Ｇが上記関係を満たす速度で移動するように駆動部３０を制御することで、ツール部１８Ａの作業対象部Ｔへの移動中に作業台３が揺れた場合であっても、ツール部１８Ａを作業対象部Ｔへ向かって高精度に移動させることができる。

【0099】

なお、駆動制御部２２Ｇは、作業対象部Ｔとツール部１８Ａとの距離の変動に応じた速度で、ツール部１８Ａの位置を作業対象部Ｔの位置へと移動させるように駆動部３０を制御してもよい。言い換えると、駆動制御部２２Ｇは、比例および積分による速度制御により、駆動部３０を制御してもよい。

【0100】

具体的には、駆動制御部２２Ｇは、下記式（３）および式（４）を満たす速度（Ｖｘ，Ｖｙ）で移動するように駆動部３０を制御してもよい。

【0101】

【数2】

【0102】

式（３）中、Ｖｘは、撮影画像におけるＸ軸方向の移動速度である。式（４）中、Ｖｙは、撮影画像におけるＹ軸方向の移動速度である。Ｋは、制御ゲインであり、任意の値を設定してよい。Ｋｉは、積分ゲインであり、任意の値を設定してよい。

【0103】

作業台３の揺れが非定常に繰り返される場合がある。このような場合、式（１）および式（２）に示す比例制御では、位置合せの誤差をゼロとすることが困難となる場合がある。このため、この場合、駆動制御部２２Ｇが上記式（３）および式（４）に示す関係を満たす速度で移動するように駆動部３０を制御することで、ツール部１８Ａの作業対象部Ｔへの移動中に作業台３の揺れが非定常に繰り返された場合であっても、ツール部１８Ａを作業対象部Ｔへ向かって高精度に移動させることができる。

【0104】

なお、ツール部１８Ａを作業対象部Ｔへ移動させる移動制御時、およびツール部１８Ａによる作業対象部Ｔに対する作業内容の実行時にも、作業台３の揺れなどによりツール部１８Ａと作業対象部Ｔとの位置にずれが生じる場合がある。

【0105】

このため、駆動制御部２２Ｇは、ツール部１８Ａの作業対象部Ｔへの移動、および、ツール部１８Ａによる作業対象部Ｔに対する作業内容の実行、の双方の駆動制御時に、取得部２２Ｅによって取得された撮影画像に応じた駆動部３０の駆動制御を繰り返し実行することが好ましい。すなわち、駆動制御部２２Ｇは、撮影画像から導出された上記相対位置に基づいたツール部１８Ａの位置と作業対象部Ｔの位置とが一致するように駆動部３０を制御する駆動制御を、ツール部１８Ａの移動制御時およびツール部１８Ａによる作業内容の実行時の双方の期間、繰り返し実行することが好ましい。

【0106】

これらの処理により、駆動制御部２２Ｇは、作業台３が揺れた場合であっても、ツール部１８Ａを作業対象部Ｔへ向かって高精度に移動させ、且つ、ツール部１８Ａの位置が作業対象部Ｔの位置へ一致した状態が維持されるように、駆動部３０を駆動制御することができる。

【0107】

なお、駆動制御部２２Ｇの制御によって、ツール部１８Ａが作業対象部Ｔに対して作業内容の作業を実行しているときに、作業台３が揺れる場合がある。この揺れによって、作業対象部Ｔからツール部１８Ａに力が加わる場合がある。

【0108】

図８を用いて説明する。図８は、インパクトドライバ１８Ａ２によるボルトＴ２のボルト締め作業実行中の一例を示す模式図である。作業台３の揺れなどによりインパクトドライバ１８Ａ２のボルトＴ２に対する位置がずれることで、ボルトＴ２からインパクトドライバ１８Ａ２に力が加わる場合がある。上述したように、力センサ１６は、作業対象部Ｔなどの外部からツール部１８Ａに加わる力を検出する。例えば、力センサ１６が、ボルトＴ２からインパクトドライバ１８Ａ２に加わる力として、第１の力Ｆｂを検出した場合を想定する。

【0109】

この場合、駆動制御部２２Ｇは、力センサ１６で検出された第１の力Ｆｂを相殺するように駆動部３０を制御することが好ましい。具体的には、駆動制御部２２Ｇは、インパクトドライバ１８Ａ２からボルトＴ２へ、検出された第１の力Ｆｂと同じ強度および同じ方向の力である力Ｆｔが加わるように、アーム機構１８の駆動部３０を制御する。

【0110】

このため、ボルトＴ２からインパクトドライバ１８Ａ２に加わる第１の力Ｆｂが相殺される。すなわち、この場合、駆動制御部２２Ｇは、作業台３の揺れを吸収するように、インパクトドライバ１８Ａ２であるアーム機構１８を駆動させることができる。

【0111】

なお、ジョイント部１９として、ダイレクトドライブモーターなどのバックドライバビリティの高い物を使用することで、作業台３揺れに対してなめらかにアーム機構１８の姿勢が変化するように調整してもよい。

【0112】

なお、駆動制御部２２Ｇは、作業台３の揺れ量に応じて、更に駆動部３０を制御してもよい。

【0113】

図９Ａおよび図９Ｂは、作業台３の揺れ量に応じた制御の一例の説明図である。

【0114】

例えば、作業対象部Ｔに対する作業台３の位置が、図９Ａに示す位置から図９Ｂに示す位置にずれた場面を想定する。

【0115】

駆動制御部２２Ｇは、作業台３の揺れ量に基づいて、作業対象部Ｔに対する作業台３の移動量を更に導出する。駆動制御部２２Ｇは、揺れ量センサ２４で検出された揺れ量を時間積分することで、時刻の各々における作業台３の揺れ方向および振幅を、作業台３の移動量として導出する。そして、駆動制御部２２Ｇは、導出した移動量を相殺するように、ジョイント部１９の位置を更に制御する。

【0116】

詳細には、ツール部１８Ａによる作業対象部Ｔに対する作業時には、ツール部１８Ａと作業対象部Ｔとの位置合せの誤差がゼロとなることが好ましい。このため、駆動制御部２２Ｇは、作業台３の移動量として導出した作業台３の揺れ方向および振幅を、ツール部１８Ａの先端に対するロボット機構部１１の目標移動量として用いる。そして、駆動制御部２２Ｇは、この目標移動量および逆運動学を用いることで、ロボット機構部１１のジョイント部１９の各々の目標位置を導出する。

【0117】

駆動制御部２２Ｇは、ツール部１８Ａを作業対象部Ｔの位置へ一致するように移動させるとき、およびツール部１８Ａによる作業対象部Ｔに対する作業中、これらの移動および作業の駆動処理のために算出したジョイント部１９の目標位置に、上記導出した目標位置を重畳する。これらの処理により、駆動制御部２２Ｇは、作業台３の揺れによるツール部１８Ａと作業対象部Ｔとの位置合せ誤差の影響を、更に低減することができる。

【0118】

次に、本実施形態の作業支援装置１０が実行する情報処理の一例を説明する。

【0119】

図１０は、本実施形態の作業支援装置１０が実行する情報処理の一例を示すフローチャートである。

【0120】

受付部２２Ａが、ＵＩ部３２から作業ＩＤを受付ける（ステップＳ１００）。ユーザは、作業開始時にＵＩ部３２を操作することで、管理情報に含まれる所望の作業ＩＤを選択する。受付部２２Ａは、ユーザによって選択された作業ＩＤを受付ける。

【0121】

第１判断部２２Ｂは、レーザ照射可能か否かを判断する（ステップＳ１０２）。第１判断部２２Ｂは、受付部２２Ａで受付けた作業ＩＤに対応する設計情報に含まれる、レーザ光Ｌによる反射の有無を表す情報を用いて、レーザ照射可能か否かを判断する。

【0122】

レーザ照射可能と判断すると（ステップＳ１０２：Ｙｅｓ）、ステップＳ１０４へ進む。ステップＳ１０４では、レーザ制御部２２Ｃが、作業対象部Ｔにレーザ光Ｌを照射するようにレーザ照射部２０を制御する（ステップＳ１０４）。レーザ制御部２２Ｃは、管理情報における作業ＩＤに対応する設計情報に含まれる作業位置情報を特定する。そして、レーザ制御部２２Ｃは、特定した作業位置情報によって表される作業位置へレーザ光Ｌを照射するようにレーザ照射器２０Ａを制御する。このため、レーザ制御部２２Ｃの制御によって、レーザ照射部２０のレーザ照射器２０Ａから作業対象部Ｔの作業位置へレーザ光Ｌが照射される。

【0123】

次に、取得部２２Ｅが、作業空間２における作業対象部Ｔおよびツール部１８Ａの撮影画像を取得する（ステップＳ１０６）。例えば、取得部２２Ｅは、図４に示す撮影画像４０を取得する。

【0124】

次に、導出部２２Ｆは、撮影画像４０に基づいて、作業対象部Ｔとツール部１８Ａとの相対位置を導出する（ステップＳ１０８）。例えば、導出部２２Ｆは、撮影画像４０におけるスポット領域Ｐ１の位置（Ｘｒ、Ｙｒ）および電動ドリル１８Ａ１の位置（Ｘｔ、Ｙｔ）を、相対位置として導出する。そして、後述するステップＳ１１８へ進む。

【0125】

一方、ステップＳ１０２でレーザ照射不可能と判断すると（ステップＳ１０２：Ｎｏ）、ステップＳ１１０へ進む。

【0126】

ステップＳ１１０では、第２判断部２２Ｄが、テンプレートマッチング処理可能か否かを判断する（ステップＳ１１０）。第２判断部２２Ｄは、例えば、撮影画像に作業対象部Ｔが存在するか否かを判別することで、テンプレートマッチング処理可能であるか否かを判断する。

【0127】

テンプレートマッチング処理可能と判断すると（ステップＳ１１０：Ｙｅｓ）、ステップＳ１１２へ進む。

【0128】

ステップＳ１１２では、取得部２２Ｅが、作業空間２における作業対象部Ｔおよびツール部１８Ａの撮影画像を取得する（ステップＳ１１２）。例えば、取得部２２Ｅは、図６に示す撮影画像４２を取得する。

【0129】

次に、導出部２２Ｆは、撮影画像４２に基づいて、作業対象部Ｔとツール部１８Ａとの相対位置を導出する（ステップＳ１１４）。例えば、導出部２２Ｆは、撮影画像４２に含まれるテンプレート画像４４に一致または類似する領域を、ボルトＴ２として特定する。そして、導出部２２Ｆは、特定したボルトＴ２の位置（Ｘｒ，Ｙｒ）およびインパクトドライバ１８Ａ２の位置（Ｘｔ，Ｙｔ）を、相対位置として導出する。そして、ステップＳ１１８へ進む。

【0130】

ステップＳ１１８では、駆動制御部２２Ｇが、ステップＳ１０８またはステップＳ１１４で導出された作業対象部Ｔとツール部１８Ａとの相対位置に基づいて、作業対象部Ｔの位置とツール部１８Ａの位置とが一致するように、アーム機構１８の駆動部３０を制御する（ステップＳ１１８）。

【0131】

駆動制御部２２Ｇは、ツール部１８Ａの位置が作業対象部Ｔの位置である作業位置に到達したか否かを判断する（ステップＳ１２０）。ステップＳ１２０で否定判断すると（ステップＳ１２０：Ｎｏ）、上記ステップＳ１０６またはステップＳ１１２へ戻る。詳細には、導出部２２Ｆが直前の処理で撮影画像４０から相対位置を導出した場合には、ステップＳ１０６へ戻る。一方、導出部２２Ｆ直前の処理で撮影画像４２から相対位置を導出した場合には、ステップＳ１１２へ戻ればよい。

【0132】

ステップＳ１２０で肯定判断すると（ステップＳ１２０：Ｙｅｓ）、ステップＳ１２２へ進む。

【0133】

ステップＳ１２２では、駆動制御部２２Ｇは、ツール部１８Ａを作業対象部Ｔへと近づけ、ステップＳ１００で受付けた作業ＩＤに対応する作業内容情報によって表される作業内容を実行するようにツール部１８Ａを制御する（ステップＳ１２２）。ステップＳ１２２の処理によって、穴あけ対象の領域Ｔ１への電動ドリル１８Ａ１による穴開け処理、ボルトＴ２へのインパクトドライバ１８Ａ２によるボルト締め処理、などの作業が実行される。

【0134】

制御部２２は、ステップＳ１２２の作業が終了したと判断するまで（ステップＳ１２２：Ｙｅｓ）否定判断（ステップＳ１２４：Ｎｏ）を繰り返す。ステップ１２２の作業が終了したと判断すると（ステップＳ１２４：Ｙｅｓ）本ルーチンを終了する。

【0135】

なお、ステップＳ１２４で否定判断した場合（ステップＳ１２４：Ｎｏ）、上記ステップＳ１０６またはステップＳ１１２へ戻ってもよい。詳細には、導出部２２Ｆが直前の処理で撮影画像４０から相対位置を導出した場合には、ステップＳ１０６へ戻る。一方、導出部２２Ｆ直前の処理で撮影画像４２から相対位置を導出した場合には、ステップＳ１１２へ戻ればよい。

【0136】

また、上述したように、ステップＳ１１８～ステップＳ１２０の処理において、駆動制御部２２Ｇは、ツール部１８Ａが位置（Ｘｔ，Ｙｔ）から作業対象部Ｔの位置（Ｘｒ，Ｙｒ）に向かって所定速度で移動するように、駆動部３０に対して速度制御処理を実行することが好ましい。所定速度は、上述したように、例えば、式（１）および式（２）、または、式（３）および式（４）を満たす速度である。

【0137】

また、上述したように、ステップＳ１２２の作業実行中、駆動制御部２２Ｇは、力センサ１６で検出された第１の力Ｆｂを相殺するように駆動部３０を更に制御することが好ましい。

【0138】

一方、上記ステップＳ１１０で否定判断すると、ステップＳ１１６へ進む。ステップＳ１１６では、ユーザが手動操作によりアーム機構１８の位置および姿勢を調整して作業を実行する手動処理を実行する（ステップＳ１１６）。そして、本ルーチンを終了する。

【0139】

以上説明したように、本実施形態の作業支援装置１０は、アーム機構１８と、第２判断部２２Ｄと、取得部２２Ｅと、導出部２２Ｆと、駆動制御部２２Ｇと、を備える。アーム機構１８は、作業空間２内に配置された作業台３に搭載され、端部にツール部１８Ａの設けられた機構である。取得部２２Ｅは、作業空間２における作業対象部Ｔおよびツール部１８Ａの撮影画像を取得する。導出部２２Ｆは、撮影画像に基づいて、作業対象部Ｔとツール部１８Ａとの相対位置を導出する。駆動制御部２２Ｇは、相対位置に基づいて、作業対象部Ｔの位置とツール部１８Ａの位置とが一致するように、アーム機構１８の駆動部３０を制御する。

【0140】

ここで、従来技術では、作業空間２の３Ｄモデルから作業対象部Ｔの位置を推定し、推定した位置に対して作業を行っていた。また、従来技術では、壁面と工具との角度の検出結果を用いて工具の傾きを調整することで、壁面の作業対象部Ｔに対する作業を支援していた。

【0141】

しかし、作業空間２内に配置された作業台３は作業空間２内で揺れる場合がある。このため、作業空間の３Ｄモデルなどによって事前に推定された作業位置が、作業台３の揺れなどによって実際の作業位置から外れる場合があった。また、作業対象５０とツール部１８Ａとの角度を検出しても、作業対象５０における作業対象部Ｔの位置とツール部１８Ａの位置とが作業台３の揺れによってずれる場合があった。このため、従来技術では、作業台３の揺れ等により正確な位置合せが困難となり作業精度が低下する場合があった。

【0142】

一方、本実施形態の作業支援装置１０は、作業対象部Ｔとツール部１８Ａとを撮影した撮影画像から相対位置を導出し、相対位置に基づいて、作業対象部Ｔの位置とツール部１８Ａの位置とが一致するように駆動部３０を制御する。

【0143】

このため、本実施形態の作業支援装置１０は、作業台３に揺れが発生した場合であっても、ツール部１８Ａと作業対象部Ｔ都の正確な位置合せを行うことができる。

【0144】

従って、本実施形態の作業支援装置１０は、作業精度の向上を図ることができる。

【0145】

次に、上記実施形態の作業支援装置１０における制御部２２および制御部２０Ｃの、ハードウェア構成の一例を説明する。

【0146】

図１１は、制御部２２およびレーザ制御部２２Ｃの一例のハードウェア構成図である。

【0147】

上記実施形態の制御部２２およびレーザ制御部２２Ｃは、ＣＰＵ８６などの制御装置と、ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）８８やＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）９０やＨＤＤ（ハードディスクドライブ）９２などの記憶装置と、各種機器とのインターフェースであるＩ／Ｆ部８２と、各部を接続するバス９６とを備えており、通常のコンピュータを利用したハードウェア構成となっている。

【0148】

上記実施形態の制御部２２およびレーザ制御部２２Ｃでは、ＣＰＵ８６が、ＲＯＭ８８からプログラムをＲＡＭ９０上に読み出して実行することにより、上記各部がコンピュータ上で実現される。

【0149】

なお、上記実施形態の制御部２２およびレーザ制御部２２Ｃで実行される上記各処理を実行するためのプログラムは、ＨＤＤ９２に記憶されていてもよい。また、上記実施形態の制御部２２およびレーザ制御部２２Ｃ主制御部３０で実行される上記各処理を実行するためのプログラムは、ＲＯＭ８８に予め組み込まれて提供されていてもよい。

【0150】

また、上記実施形態の制御部２２およびレーザ制御部２２Ｃで実行される上記処理を実行するためのプログラムは、インストール可能な形式または実行可能な形式のファイルでＣＤ－ＲＯＭ、ＣＤ－Ｒ、メモリカード、ＤＶＤ（Ｄｉｇｉｔａｌ Ｖｅｒｓａｔｉｌｅ Ｄｉｓｋ）、フレキシブルディスク（ＦＤ）等のコンピュータで読み取り可能な記憶媒体に記憶されてコンピュータプログラムプロダクトとして提供されるようにしてもよい。また、上記実施形態の制御部２２およびレーザ制御部２２Ｃで実行される上記処理を実行するためのプログラムを、インターネットなどのネットワークに接続されたコンピュータ上に格納し、ネットワーク経由でダウンロードさせることにより提供するようにしてもよい。また、上記実施形態の制御部２２およびレーザ制御部２２Ｃで実行される上記処理を実行するためのプログラムを、インターネットなどのネットワーク経由で提供または配布するようにしてもよい。

【0151】

なお、上記には、本発明の実施形態を説明したが、上記実施形態は、例として提示したものであり、発明の範囲を限定することは意図していない。この新規な実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。この実施形態やその変形は、発明の範囲や要旨に含まれるとともに、特許請求の範囲に記載された発明とその均等の範囲に含まれる。

【符号の説明】

【0152】

１０ 作業支援装置
１２ 撮影部
１８ アーム機構
１９ ジョイント部
２０ レーザ照射部
２２Ｂ 第１判断部
２２Ｃ レーザ制御部
２２Ｄ 第２判断部
２２Ｅ 取得部
２２Ｆ 導出部
２２Ｇ 駆動制御部
３０ 駆動部

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9A】

【図9B】

【図10】

【図11】