特許 7707584 情報処理装置および情報処理方法、並びにプログラム

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

(12)【公報種別】特許公報(B2)

(11)【特許番号】

(24)【登録日】2025-07-07

(45)【発行日】2025-07-15

(54)【発明の名称】情報処理装置および情報処理方法、並びにプログラム

(51)【国際特許分類】

   B25J 19/06 20060101AFI20250708BHJP

【ＦＩ】

B25J19/06

【請求項の数】 14

(21)【出願番号】P 2021040582

(22)【出願日】2021-03-12

(65)【公開番号】P2022139974

(43)【公開日】2022-09-26

【審査請求日】2024-01-16

(73)【特許権者】

【識別番号】000002945

【氏名又は名称】オムロン株式会社

(74)【代理人】

【識別番号】110002860

【氏名又は名称】弁理士法人秀和特許事務所

(72)【発明者】

【氏名】三嶋 一馬

【審査官】神山 貴行

(56)【参考文献】

【文献】国際公開第２０１９／２４００５１（ＷＯ，Ａ１）

【文献】特開２０１９－０９８４３１（ＪＰ，Ａ）

【文献】特開平０２－２７６９０１（ＪＰ，Ａ）

(58)【調査した分野】(Int.Cl.，ＤＢ名)

Ｂ２５Ｊ １／００－２１／０２

(57)【特許請求の範囲】

【請求項1】

センサがその測定可能領域にロボットの少なくとも一部が入るように設置された状態で測定・出力した距離情報を取得する取得手段と、
前記ロボットを動かしながら複数のタイミングで前記センサにより測定された前記距離情報に基づいて、前記ロボットが実作動中に動き得る領域である３次元の動作範囲を認識する認識手段と、
前記ロボットの実作動中に前記センサにより測定された前記距離情報に基づいて、前記ロボットの３次元の動作範囲に変化があったか否かの判定を行う判定手段と、
前記判定手段が前記ロボットの３次元の動作範囲に変化があったと判定した場合に、前記センサ自身の設置位置又は光軸にズレが生じている旨の警告を行う警告手段と、
を有することを特徴とする情報処理装置。

【請求項2】

前記認識手段は、
前記複数のタイミングで前記センサにより測定された前記距離情報の夫々を、前記測定可能領域における各物体の占める範囲を示す物体範囲情報に変換し、
前記物体範囲情報から、前記測定可能領域における前記ロボット以外の物体の占める範囲を示す周辺環境情報を除いて、前記測定可能領域における前記ロボットの占める範囲を示す実動作情報を生成し、
前記複数のタイミングでの前記実動作情報を重ね合わせて、前記ロボットの３次元の動作範囲を算出することを特徴とする請求項１に記載の情報処理装置。

【請求項3】

前記ロボットを停止させた状態で前記センサにより測定された前記距離情報に基づき、前記周辺環境情報を設定する設定手段を更に有することを特徴とする請求項２に記載の情報処理装置。

【請求項4】

前記複数のタイミングで前記センサにより測定された前記距離情報は、前記実作動中と同じ動作で前記ロボットを動かしながら前記センサにより測定された距離情報であることを特徴とする請求項１～３のいずれか１項に記載の情報処理装置。

【請求項5】

前記ロボットによる作業内容が変更する毎に、前記認識手段は変更後の作業内容に応じた前記ロボットの動作範囲を認識することを特徴とする請求項１～４のいずれか１項に記載の情報処理装置。

【請求項6】

前記ロボットの３次元の動作範囲に基づいて危険エリアを決定する決定手段と、
前記ロボットの実作動中に前記センサにより測定された前記距離情報に基づいて、前記危険エリアへ近づく侵入物を監視する監視手段と、
を更に備えることを特徴とする請求項１～５のいずれか１項に記載の情報処理装置。

【請求項7】

前記決定手段は、前記ロボットの３次元の動作範囲と余裕度を考慮して前記危険エリアの大きさを決定するものであり、
前記余裕度は、ユーザ変更可能であることを特徴とする請求項６に記載の情報処理装置。

【請求項8】

前記危険エリアの外側に、安全距離が考慮された３次元領域である防護エリアを設定する防護エリア設定手段を更に備え、
前記監視手段は、前記防護エリアにおいて前記危険エリアへ近づく侵入物を監視することを特徴とする請求項６又は７に記載の情報処理装置。

【請求項9】

前記防護エリア設定手段は、前記測定可能領域における前記ロボット以外の物体の占める範囲を示す周辺環境情報を考慮して前記防護エリアを設定することを特徴とする請求項８に記載の情報処理装置。

【請求項10】

前記監視手段は、前記ロボットの実作動中に前記センサにより測定された前記距離情報に基づいて、前記防護エリアへ侵入した物体を検知した場合に、前記物体が前記危険エリアの反対側から前記防護エリアに侵入したのか、前記危険エリアから前記防護エリアに移動したのかを判断し、
前記監視手段が前記危険エリアから前記防護エリアに移動する物体を検知した場合に、前記センサのズレまたは前記ロボットの誤作動が発生した可能性があると判定し、危険警告を行う危険警告手段を更に備えることを特徴とする請求項８又は９に記載の情報処理装置。

【請求項11】

前記監視手段が前記危険エリアの反対側から前記防護エリアに侵入する物体を検知した場合に、前記ロボットを低速駆動または停止させる安全制御を行う、安全制御手段を更に備えることを特徴とする請求項１０に記載の情報処理装置。

【請求項12】

前記測定可能領域の外に位置する領域が前記防護エリアに存在する場合、警告を行うことを特徴とする請求項８～１１のいずれか１項に記載の情報処理装置。

【請求項13】

センサがその測定可能領域にロボットの少なくとも一部が入るように設置された状態で測定・出力した距離情報を取得するステップと、
前記ロボットを動かしながら複数のタイミングで前記センサにより測定された前記距離情報に基づいて、前記ロボットが実作動中に動き得る領域である３次元の動作範囲を認識するステップと、
前記ロボットの実作動中に前記センサにより測定された前記距離情報に基づいて、前記ロボットの３次元の動作範囲に変化があったか否かの判定を行うステップと、
前記ロボットの３次元の動作範囲に変化があったと判定された場合に、前記センサ自身の設置位置又は光軸にズレが生じている旨の警告を行うステップと、
を有することを特徴とする情報処理方法。

【請求項14】

請求項１３に記載の情報処理方法の各ステップをコンピュータに実行させるためのプログラム。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、情報処理装置および情報処理方法、並びにプログラムに関する。

【背景技術】

【0002】

生産現場のような監視が必要な場面において、人体等の物体を検出するためにセンサが用いられている。

【0003】

例えば、３Ｄセンサを使用して、ロボット周辺の所定のエリアの監視を行い、作業者等がロボットに近づいた場合にロボットの減速や停止等の安全制御を行うシステムが知られている。このシステムでは、監視する所定のエリアが、３Ｄセンサで撮影された画像を用いて学習されたロボットの動作範囲に基づき設定される（例えば、特許文献１参照）。

【先行技術文献】

【特許文献】

【0004】

【文献】特表２０２０－５１１３２５号公報

【発明の概要】

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

【0005】

しかしながら、特許文献１では、センサに設置位置ズレや光軸ズレといったズレが生じた場合に、監視する所定のエリアで物体を確実に検出することができなくなる。その一方、かかるセンサのズレをユーザが認識するのは容易でない。

【0006】

そこで本発明は、センサのズレをユーザが容易に認識することができる技術を提供することを目的とする。

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

【0007】

上記目的を達成するために本発明は、以下の構成を採用する。

【0008】

本発明の第一側面は、センサがその測定可能領域にロボットの少なくとも一部が入るように設置された状態で測定・出力した距離情報を取得する取得手段と、前記ロボットを動かしながら複数のタイミングで前記センサにより測定された前記距離情報から前記ロボットの３次元の動作範囲を認識する認識手段と、前記ロボットの実作動中に前記センサにより測定された前記距離情報に基づいて、前記ロボットの３次元の動作範囲に変化があったか否かの判定を行う判定手段と、前記判定手段が前記ロボットの３次元の動作範囲に変化があったと判定した場合に、前記センサのズレが生じている旨の警告を行う警告手段と、を有することを特徴とする情報処理装置を提供する。

【0009】

「センサ」は、一例としてＴＯＦ（Time of Flight）センサである。

【0010】

この構成によれば、ロボットの実作動中にセンサにより測定された距離情報に基づいて、ロボットの３次元の動作範囲に変化があったか否かの判定を行い、ロボットの３次元の動作範囲に変化があった場合は、センサのズレが生じている旨の警告を行う。これにより、センサのズレをユーザが容易に認識することができる。

【0011】

また、前記認識手段は、前記複数のタイミングで前記センサにより測定された前記距離情報の夫々を、前記測定可能領域における各物体の占める範囲を示す物体範囲情報に変換し、前記物体範囲情報から、前記測定可能領域における前記ロボット以外の物体の占める
範囲を示す周辺環境情報を除いて、前記測定可能領域における前記ロボットの占める範囲を示す実動作情報を生成し、前記複数のタイミングでの前記実動作情報を重ね合わせて、前記ロボットの３次元の動作範囲を算出してもよい。これにより、ロボットの３次元の動作範囲、ひいてはこれに基づいて決定される危険エリアの決定を短時間で行うことができる。

【0012】

また、前記ロボットを停止させた状態で前記センサにより測定された前記距離情報に基づき、前記周辺環境情報を設定する設定手段を更に有してもよい。これにより、周辺環境情報の設定を簡便に行うことができる。

【0013】

また、前記複数のタイミングで前記センサにより測定された前記距離情報は、前記実作動中と同じ動作で前記ロボットを動かしながら前記センサにより測定された距離情報であってもよい。これにより、実作動中のロボットの動作範囲の変化、ひいてはセンサのズレを精度良く判定することができる。また、ロボットの動作範囲に基づいて危険エリアや防護エリアを設定する場合に、最小限かつ最適な危険エリアおよび防護エリアを設定することができる。

【0014】

また、前記ロボットによる作業内容が変更する毎に、前記認識手段は変更後の作業内容に応じた前記ロボットの動作範囲を認識してもよい。これにより、ロボットによる作業内容の変更に応じてロボットの動作範囲が変化したとしても、センサのズレを精度良く判定することができる。また、ロボットの動作範囲に基づいて危険エリアや防護エリアを設定する場合に、ロボットの作業内容に応じて、最小限かつ最適な危険エリアおよび防護エリアを設定することができる。

【0015】

また、前記ロボットの３次元の動作範囲に基づいて危険エリアを決定する決定手段と、前記ロボットの実作動中に前記センサにより測定された前記距離情報に基づいて、前記危険エリアへ近づく侵入物を監視する監視手段と、を更に備えてもよい。センサの測定結果から認識したロボットの動作範囲に基づいて危険エリアを決定することにより、適切な位置・大きさの危険エリアを自動で決定することができ、侵入物の監視を適切に行うことが可能となる。

【0016】

また、前記決定手段は、前記ロボットの３次元の動作範囲と余裕度を考慮して前記危険エリアの大きさを決定するものであり、前記余裕度は、ユーザ変更可能であってもよい。これにより、危険エリアの大きさを簡便に変更することができる。

【0017】

また、前記危険エリアの外側に、安全距離が考慮された３次元領域である防護エリアを設定する防護エリア設定手段を更に備え、前記監視手段は、前記防護エリアにおいて前記危険エリアへ近づく侵入物を監視してもよい。これにより、危険エリアに近づく侵入物が危険エリアに到達するまでにロボットが減速・停止を確実に完了させることができる。

【0018】

また、前記防護エリア設定手段は、前記測定可能領域における前記ロボット以外の物体の占める範囲を示す周辺環境情報を考慮して前記防護エリアを設定してもよい。これにより、必要最小限の防護エリアを設定することができる。

【0019】

また、前記監視手段は、前記ロボットの実作動中に前記センサにより測定された前記距離情報に基づいて、前記危険エリアから前記防護エリアに移動する物体の検知を更に行い、前記監視手段が前記危険エリアから前記防護エリアに移動する物体を検知した場合に、危険警告を行う危険警告手段を更に備えてもよい。一般的な状況において危険エリアから防護エリアに物体が移動することは考え難いため、危険エリアから防護エリアに移動する物体が検知されたということは、センサのズレもしくは故障、あるいは、ロボットの誤作
動が生じた可能性が想定され、いずれの場合も危険性があるからである。

【0020】

前記測定可能領域の外に位置する領域が前記防護エリアに存在する場合、警告を行ってもよい。測定可能領域の外に位置する領域は、センサで距離情報を測定できず、防護エリアとして利用できないためである。

【0021】

本発明の第二側面は、センサがその測定可能領域にロボットの少なくとも一部が入るように設置された状態で測定・出力した距離情報を取得するステップと、前記ロボットを動かしながら複数のタイミングで前記センサにより測定された前記距離情報から前記ロボットの３次元の動作範囲を認識するステップと、前記ロボットの実作動中に前記センサにより測定された前記距離情報に基づいて、前記ロボットの３次元の動作範囲に変化があったか否かの判定を行うステップと、前記ロボットの３次元の動作範囲に変化があったと判定された場合に、前記センサのズレが生じている旨の警告を行うステップと、を有することを特徴とする情報処理方法を提供する。

【0022】

本発明の第三側面は、上記情報処理方法の各ステップをコンピュータに実行させるためのプログラムを提供する。

【0023】

本発明は、上記手段の少なくとも一部を有する情報処理装置、センサズレ判定装置などとして捉えてもよいし、これらの装置とセンサとを含む物体検知システム、監視システムなどとして捉えてもよい。また、本発明は、上記処理の少なくとも一部を有する情報処理方法、センサズレ判定方法、物体検知方法、監視方法、あるいは制御方法として捉えてもよい。また、本発明は、かかる方法を実現するためのプログラムやそのプログラムを非一時的に記録した記録媒体として捉えることもできる。尚、上記手段ないし処理の各々は可能な限り互いに組み合わせて本発明を構成することができる。

【発明の効果】

【0024】

本発明によれば、センサのズレをユーザが容易に認識することができることができる。

【図面の簡単な説明】

【0025】

【図1】図１は、本発明の一実施の形態に係る情報処理装置及びセンサを含む監視システムのブロック図である。

【図2】図２は、制御部の機能ブロック図である。

【図3】図３は、監視システムが用いられる現場の模式的な側面図である。

【図4】図４は、ロボットの動作範囲を示す図である。

【図5】図５は、センサズレ検知処理を示すフローチャートである。

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

【0026】

＜適用例＞
図１～図３を参照して、本発明に係る情報処理装置の適用例を説明する。図１は、本発明の一実施の形態に係る情報処理装置５０を含む監視システムのブロック図である。図２は、制御部の機能ブロック図である。図３は、監視システムが用いられる現場の模式的な側面図である。各部の方向を、図３に示したＸ、Ｙ、Ｚ座標軸を基準として呼称する。センサ１０からみて、前方が＋Ｙ方向、上方が＋Ｚ方向、右方が＋Ｘ方向である。

【0027】

図３に示すように、３次元の距離情報を測定・出力する３次元距離センサ１０（以下、センサ１０と記す）が用いられる現場として、危険源であるロボットや機械（以下、単に「ロボット３０２」という）が作業者と協働しながら生産を行う生産現場のように、物体の監視が必要な場所が想定される。ロボット３０２は、作業台３０３の上に設置され、実作動中に３次元の動作範囲である動線３０５を通過するため、例えば動線３０５上に作業
者が手を出した場合、ロボット３０２と衝突してしまう。このため、作業者が手を出すとロボット３０２と現に衝突する、又は衝突する可能性が高い危険なエリアである危険エリア３０６として、ロボット３０２の動線３０５を含み、且つ、ロボット３０２の動線３０５よりもひとまわり大きく設定した３次元領域を決定し、ロボット３０２の実作動中に、センサ１０を用いて、危険エリア３０６に近づく人体等の物体（侵入物）を監視する。

【0028】

一方、ロボットの実作動中に、センサ１０に設置当初からの位置ズレや光軸ズレ（以下単に「センサ１０のズレ」という）が生じた場合、ユーザにその旨を警告する必要がある。センサ１０のズレが生じていると、センサ１０の測定結果に影響し、誤差が生じるおそれがある一方、かかるセンサのズレをユーザが認識するのは容易でないからである。

【0029】

そこで、本実施の形態では、図３に示すように、ユーザは、センサ１０を、その測定可能領域３０１にロボット３０２の少なくとも一部が入るように設置する。この状態で、取得手段としての制御部３０のセンシング部２０１（図２）は、センサ１０で測定・出力された距離情報を取得する。そして、認識手段としての制御部３０の動線認識部２０２（図２）は、ロボット３０２を動かしながらセンサ１０より測定された距離情報からロボット３０２の動線３０５を認識する。このとき、動線上のさまざまな位置・姿勢におけるロボット３０２の外形を測定するために、複数のタイミングで距離情報の測定が行われる。決定手段としての制御部３０の危険エリア自動設定部２０３（図２）は、動線３０５に基づいて危険エリア３０６を決定する。判定手段としての制御部３０の実作動制御部２０６（図２）は、ロボット３０２の実作動中にセンサ１０より測定された距離情報に基づいて、ロボット３０２の動線３０５に変化があった、すなわちセンサ１０のズレが生じているか否かの判定を行う。警告手段としての制御部３０の警告／安全制御部２１０（図２）は、実作動制御部２０６において、センサ１０のズレが生じていると判定された場合、その旨の警告を行う。

【0030】

防護エリア設定手段としての制御部３０の防護エリア自動設定部２０４（図２）は、危険エリア３０６の外側に、安全距離が考慮された３次元領域である防護エリア３０４（図３）を設定する。監視手段としての実作動制御部２０６（図２）は、ロボット３０２の実作動中にセンサ１０より測定された距離情報に基づいて、防護エリア３０４への侵入物、すなわち、危険エリア３０６へ近づく侵入物を監視する。例えば、防護エリア３０４内に人体等の物体が入ると、警告／安全制御部２１０が、ロボット３０２を低速駆動または停止させる等の安全制御を行う。実作動制御部２０６は、防護エリア３０４への侵入物を検知した場合に、さらに、当該侵入物が、危険エリア３０６の反対側から防護エリア３０４に侵入したのか、危険エリア３０６から防護エリア３０４に侵入したのかを判断してもよい。前者の場合は人体等の侵入とみなしてよい。一方、後者の場合は人体等の侵入である可能性は低いため、センサ１０のズレまたはロボット３０２の誤動作である可能性が高い。警告／安全制御部２１０（図２）は、実作動制御部２０６において、センサ１０のズレまたはロボット３０２の誤動作が発生したと判定された場合、危険警告を行う。

【0031】

図１に示すように、センサ１０は、発光部４１、受光部４２および演算部４３を備える。発光部４１は光（例えば、赤外光）を出射し、受光部４２は反射光を受光する。センサ１０には、一例として、光の飛行時間（Time of Flight：TOF）から距離画像を取得する
ＴＯＦセンサが採用される。例えば、投影光と反射光の位相差から時間差を推定する間接型ＴＯＦセンサが採用される。センサ１０は、３次元の距離情報および輝度情報を測定結果として出力する。センサ１０による測定結果は、測定可能領域３０１内の各位置の距離情報を含んでいる。測定結果は情報処理装置５０におけるセンサＩ／Ｆ４４を介して制御部３０に供給される。センサ１０は、センサＩ／Ｆ４４を介して制御部３０によって制御される。

【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】

１０：センサ
３０：制御部
５０：情報処理装置
２０１：センシング部
２０２：動線認識部
２０３：危険エリア自動設定部
２０６：実作動制御部
２１０：警告／安全制御部
３０１：測定可能領域
３０２：ロボット
３０３：作業台
３０４：防護エリア
３０５：動線
３０６：危険エリア

【図1】

【図2】

【図3】

【図4】

【図5】