ロボット装置の制御装置及びロボット装置の制御方法
【課題】マニピュレータを備えたロボット装置の制御装置において、マニピュレータと人との干渉、接触を確実に防止しつつ、装置のダウンタイムを減少させ、稼働効率が低下しないようにする。
【解決手段】マニピュレータ１の可動領域を包括し可動領域よりも広い領域であって侵入物体１０１の侵入が可能である警戒領域Ｂに対する侵入物体１０１の侵入を監視する侵入検知手段６と、マニピュレータ１の動作状態を特定するとともにマニピュレータ１の動作を制御する制御手段３，７とを備える。制御手段３，７は、検知手段６により、警戒領域Ｂ内への侵入物体１０１の侵入が検知された場合には、マニピュレータ１の動作を減速させ、マニピュレータ１の可動領域Ａ内への侵入物体１０１の侵入が検知されるとともにマニピュレータ１と侵入物体１０１との距離が所定の距離以下となったときには、マニピュレータ１の動作を停止させる。
【解決手段】マニピュレータ１の可動領域を包括し可動領域よりも広い領域であって侵入物体１０１の侵入が可能である警戒領域Ｂに対する侵入物体１０１の侵入を監視する侵入検知手段６と、マニピュレータ１の動作状態を特定するとともにマニピュレータ１の動作を制御する制御手段３，７とを備える。制御手段３，７は、検知手段６により、警戒領域Ｂ内への侵入物体１０１の侵入が検知された場合には、マニピュレータ１の動作を減速させ、マニピュレータ１の可動領域Ａ内への侵入物体１０１の侵入が検知されるとともにマニピュレータ１と侵入物体１０１との距離が所定の距離以下となったときには、マニピュレータ１の動作を停止させる。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ロボット装置の制御装置及びロボット装置の制御方法に関し、ロボット装置のマニピュレータの可動領域に人などが侵入した場合の保安、安全の向上を図ったロボット装置の制御装置及びロボット装置の制御方法に関する。
【背景技術】
【０００２】
従来、マニピュレータを備えたロボット装置が提案されている。このようなロボット装置においては、マニピュレータの可動領域に人などが侵入する可能性がある。このような場合の保安、安全を図るため、従来のロボット装置においては、マニピュレータの可動領域の外側に、入退扉を有する安全柵等を設置することが行われている。そして、この安全柵の入退扉に開閉状態を検出するスイッチを設けておき、あるいは、ライトカーテン等により、いわば出入口管理により、安全柵内への人の侵入を検知するようにしている。ロボット装置の制御装置は、安全柵内への人等の侵入が検知された場合には、ロボット装置への駆動電源の供給を遮断し、ロボット装置を非常停止させるようになっている。
【０００３】
また、特許文献１には、人とマニピュレータとの接触可能性のあるエリアを限定し、このエリアを重点的にカメラにより監視しておき、状況に応じて、マニピュレータの動作を減速させ、あるいは、非常停止させるようにしたロボット装置が記載されている。
【０００４】
特許文献２には、カメラ等による監視を行い、侵入者を検出した場合には、警告を発するようにしたロボット装置が記載されている。
【０００５】
特許文献３には、カメラ等による監視を行い、侵入者を検出した場合には、侵入者の位置及び速度等の状況を分析し、マニピュレータとの接触可能性のある領域との位置及び速度等の関係から、マニピュレータの動作を減速させ、あるいは、非常停止させるようにしたロボット装置が記載されている。
【０００６】
さらに、特許文献４には、マニピュレータを近似立体を使ってモデル化し、人等との干渉や接触を確認するようにしたロボット装置が記載されている。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】特開２００７−２８３４５０号公報
【特許文献２】特許第３７０４７０６号公報
【特許文献３】特表２００６−５０１４８７号公報
【特許文献４】特許第２６７８００５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００８】
ところで、従来のロボット装置において、入退扉の開閉状態の検出により侵入者を検知するようにした場合には、作業者の過失により、作業者が安全柵内に残っている状態で入退扉を閉めてしまった場合には、マニピュレータの非常停止状態が解除されてしまい、作業者とマニピュレータとが接触する可能性が生ずる。
【０００９】
また、このようなロボット装置においては、安全柵の内側の全ての領域がマニピュレータの可動領域というわけではないため、安全柵の設置により、ロボット装置そのものが占有する面積よりも大きな面積が占有されることになってしまい、スペース効率の低下を招くこととなる。
【００１０】
さらに、このロボット装置においては、入退扉が解放された場合には、マニピュレータと人との接触可能性がない状態や、または、接触の可能性がすぐには生じない状態であっても、ロボット装置は非常停止され、稼働効率の低下を招くこととなる。例えば、マニピュレータが安全柵の入退扉とは反対側で作業をしている状況において、マニピュレータが次に把持すべきワークの位置がずれていることが分かったとする。このままの状態で把持を行おうとすれば、マニピュレータは、把持に失敗し、停止することになる。このような状況では、マニピュレータが入退扉の付近に移動してくるには十分な時間があり、その間に作業者がワークの位置を修正することができる状況ではあるが、入退扉を解放すれば、マニピュレータは非常停止してしまうため、無駄な時間が生ずる。
【００１１】
そして、このような状況においては、作業者は、無駄な時間が生ずることを嫌って、非常停止の機能を解除してしまうことが考えられる。すなわち、入退扉を解放してもマニピュレータが非常停止しない状態として、安全柵内に侵入することが考えられる。この場合において、作業者の思い違い、見込み違いや、ロボット装置に対する理解不足などから、予想に反してマニピュレータが戻ってしまい、マニピュレータと作業者とが接触する虞が生ずる。
【００１２】
また一般的に、ロボット装置は、一旦、非常停止により駆動電源の遮断やプログラムリセット等が生じてしてしまうと、非常停止状態を確認し、解除した後に、マニピュレータを初期状態（原点位置等）に戻し、また、仕掛かり中のワークを元の位置に戻すなどしたうえで、プログラムを再始動するといった復旧作業が必要となる。そのため、多くの装置のダウンタイムが発生し、これらの作業を行うための作業員も必要となり、生産効率が大きく低下してしまう。
【００１３】
したがって、ロボット装置においては、安全の確保を前提としつつも、装置のダウンタイムを減少させ、稼働効率を低下させないことが期待される。
【００１４】
特許文献１に記載されたロボット装置においては、マニピュレータと人との接触可能性のある領域を限定できる場合には有効である。しかし、マニピュレータの可動領域を大きくした場合には、この可動領域内において人が侵入できる場所及び侵入する必要のある場所が多くなり、マニピュレータの可動領域のほぼ全体を監視しなければならなくなる。したがって、安全を確保するためには、侵入による非常停止が頻繁に発生することとなり、稼働効率の低下が招来される。
【００１５】
そのため、このロボット装置においては、人が侵入できる領域を集約しておく必要があるため、セルの設計自由度が低く、ロボットが比較的大きく動かない特定の小型セルや分割された作業エリアなどにしか適用することができない。
【００１６】
そして、特許文献２に記載されたロボット装置においては、マニピュレータの可動領域への人の侵入のみを監視しており、マニピュレータの動作については監視していない。また、特許文献３に記載されたロボット装置においても、人の挙動のみを監視対象としており、マニピュレータの動作及び挙動は監視していない。このように、これら特許文献２及び特許文献３に記載されたロボット装置においては、人の挙動のみを監視装置により監視するため、作業者の安全は確保されるが、人の侵入可能領域がマニピュレータの動作によって変化することはない。例えば、マニピュレータと作業者との間に十分な安全距離が確保されていたとしても、マニピュレータの可動領域に人が侵入するなり、マニピュレータは非常停止するので、稼働効率の低下は避けられない。
【００１７】
特許文献４に記載されたロボット装置においては、複数のマニピュレータ同士や、マニピュレータの可動領域と物品との干渉や接触を確認する方法であり、人とマニピュレータとの干渉や接触を対象としていない。
【００１８】
そこで、本発明は、前記の実情に鑑みてなされたものであり、その目的は、マニピュレータと人との干渉、接触が防止され、安全性が高まり、装置のダウンタイムが減少され、稼働効率が低下しないようになされたロボット装置の制御装置及びロボット装置の制御方法を提供することにある。
【課題を解決するための手段】
【００１９】
前述の課題を解決し、前記目的を達成するため、本発明に係るロボット装置の制御装置は、以下の構成を有するものである。
【００２０】
〔構成１〕
マニピュレータを備えたロボット装置の動作を制御するためのロボット装置の制御装置であって、マニピュレータの可動領域を包括し該可動領域よりも広い領域であって侵入物体の侵入が可能である警戒領域に対する侵入物体の侵入を監視する侵入検知手段と、マニピュレータの動作状態を特定するとともに該マニピュレータの動作を制御する制御手段とを備え、制御手段は、検知手段により、警戒領域内への侵入物体の侵入が検知された場合には、マニピュレータの動作を減速させ、マニピュレータの可動領域内への侵入物体の侵入が検知されるとともにマニピュレータと侵入物体との距離が所定の距離以下となったときには、マニピュレータの動作を停止させることを特徴とするものである。
【００２１】
〔構成２〕
構成１を有するロボット装置の制御装置において、侵入検知手段は、３次元認識センサであって、制御手段は、侵入検知手段による検知結果に基づいて侵入物体を包絡する第１の近似立体を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００２２】
これら近似立体としては、球、円筒、多面体等、どのような形状であってもよいが、侵入物体として想定される人と、マニピュレータとを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似立体は、複数の立体が組合わさったものであってもよい。
【００２３】
〔構成３〕
構成１を有するロボット装置の制御装置において、侵入検知手段は、２次元認識センサ、または、３次元認識センサであって、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００２４】
これら近似図形としては、円、多角形等、どのような形状であってもよいが、侵入物体として想定される人の投影図形と、マニピュレータの投影図形とを、無駄なく包絡できる形状で、かつ、近似図形同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似図形は、複数の図形が組合わさったものであってもよい。
【００２５】
〔構成４〕
構成１を有するロボット装置の制御装置において、侵入検知手段は、３次元認識センサであって、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の中心点を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００２６】
〔構成５〕
構成１を有するロボット装置の制御装置において、侵入検知手段は、２次元認識センサ、または、３次元認識センサであって、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の水平面への投影図形の中心点及び水平面上において中心点から一定の距離の点を包絡した近似図形を設定するとともに、侵入検知手段によりマニピュレータの動作状態を特定しマニピュレータの水平面への投影図形を設定しこれら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００２７】
近似図形としては、円、多角形等、どのような形状であってもよいが、侵入物体として想定される人の投影図形を、無駄なく包絡できる形状で、かつ、近似図形同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似図形は、複数の図形が組合わさったものであってもよい。
【００２８】
〔構成６〕
構成１、構成２、構成３、または、構成５を有するロボット装置の制御装置において、マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、警戒領域、近似立体、または、近似図形を拡大することを特徴とするものである。
【００２９】
また、本発明に係るロボット装置の制御方法は、以下の構成を有するものである。
【００３０】
〔構成７〕
構成１、構成２、構成３、または、構成５を有するロボット装置の制御装置において、侵入物体を包括する警戒領域を設定し、この警戒領域及びマニピュレータの可動領域を包括する警戒領域の少なくとも一方について、これら警戒領域よりも狭い一、または、二以上に多重化された危険領域を設定して多重化し、侵入物体領域とマニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、侵入物体領域とマニピュレータとの接近に応じて順次多段的に減速することを特徴とするものである。
【００３１】
〔構成８〕
マニピュレータを備えたロボット装置の動作を制御するためのロボット装置の制御方法であって、マニピュレータの可動領域を包括し該可動領域よりも広い領域であって侵入物体の侵入が可能である警戒領域に対する侵入物体の侵入を監視し、警戒領域内への侵入物体の侵入が検知された場合には、マニピュレータの動作を減速させ、マニピュレータの可動領域内への侵入物体の侵入が検知されるとともにマニピュレータと侵入物体との距離が所定の距離以下となったときには、マニピュレータの動作を停止させることを特徴とするものである。
【００３２】
〔構成９〕
構成８を有するロボット装置の制御方法において、侵入物体の監視結果に基づいて侵入物体を包絡する第１の近似立体を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００３３】
これら近似立体としては、球、円筒、立方体を含む正多面体等、どのような形状であってもよいが、侵入物体として想定される人と、マニピュレータとを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似立体は、複数の立体が組合わさったものであってもよい。
【００３４】
〔構成１０〕
構成８を有するロボット装置の制御方法において、侵入物体の監視結果に基づいて侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００３５】
これら近似図形としては、円、正方形を含む正多角形等、どのような形状であってもよいが、侵入物体として想定される人の投影図形と、マニピュレータの投影図形とを、無駄なく包絡できる形状で、かつ、近似図形同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似図形は、複数の図形が組合わさったものであってもよい。
【００３６】
〔構成１１〕
構成８を有するロボット装置の制御方法において、侵入物体の監視結果に基づいて侵入物体の中心点を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００３７】
〔構成１２〕
構成８を有するロボット装置の制御方法において、侵入物体の監視結果に基づいて侵入物体の水平面への投影図形の中心点及び水平面上において中心点から一定の距離の点を包絡した近似図形を設定するとともに、マニピュレータを監視することによりマニピュレータの動作状態を特定しマニピュレータの水平面への投影図形を設定し、これら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００３８】
近似図形としては、円、多角形等、どのような形状であってもよいが、侵入物体として想定される人の投影図形を、無駄なく包絡できる形状で、かつ、近似図形同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似図形は、複数の図形が組合わさったものであってもよい。
【００３９】
〔構成１３〕
構成８、構成９、構成１０、または、構成１２を有するロボット装置の制御方法において、マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、警戒領域、近似立体、または、近似図形を拡大することを特徴とするものである。
【００４０】
〔構成１４〕
構成８、構成９、構成１０、または、構成１２を有するロボット装置の制御方法において、侵入物体を包括する警戒領域を設定し、この警戒領域及びマニピュレータの可動領域を包括する警戒領域の少なくとも一方について、これら警戒領域よりも狭い一、または、二以上に多重化された危険領域を設定して多重化し、侵入物体領域とマニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、侵入物体領域とマニピュレータとの接近に応じて順次多段的に減速することを特徴とするものである。
【発明の効果】
【００４１】
構成１を有する本発明に係るロボット装置の制御装置においては、制御手段は、検知手段により、警戒領域内への侵入物体の侵入が検知された場合には、マニピュレータの動作を減速させ、マニピュレータの可動領域内への侵入物体の侵入が検知されるとともにマニピュレータと侵入物体との距離が所定の距離以下となったときには、マニピュレータの動作を停止させる。
【００４２】
したがって、このロボット装置の制御装置においては、侵入物体がマニピュレータに接近して警戒領域内へ侵入しても、いきなりマニピュレータが停止することなく、まず、マニピュレータが減速される。このときに、侵入物体をマニピュレータから遠ざけることができれば、マニピュレータを停止させることがないので、ダウンタイムを最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。
【００４３】
そして、侵入物体がマニピュレータの可動領域内に侵入するとともに、マニピュレータと侵入物体との距離が所定の距離以下となったときに、マニピュレータの動作が停止されるので、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。また、このときには、マニピュレータが減速されているので、マニピュレータの動作状態を正確に特定することが容易となる。
【００４４】
構成２を有する本発明に係るロボット装置の制御装置においては、制御手段は、侵入検知手段による検知結果に基づいて侵入物体を包絡する第１の近似立体を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を確実に判別することができる。
【００４５】
構成３を有する本発明に係るロボット装置の制御装置においては、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００４６】
構成４を有する本発明に係るロボット装置の制御装置においては、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の中心点を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００４７】
構成５を有する本発明に係るロボット装置の制御装置においては、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の水平面への投影図形の中心点及び水平面上において中心点から一定の距離の点を包絡した近似図形を設定するとともに、侵入検知手段によりマニピュレータの動作状態を特定しマニピュレータの水平面への投影図形を設定しこれら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００４８】
構成６を有する本発明に係るロボット装置の制御装置においては、マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、警戒領域、近似立体、または、近似図形を拡大するので、マニピュレータがワークを把持している場合においても、マニピュレータと侵入物体との接近を容易に判別することができ、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。
【００４９】
構成７を有する本発明に係るロボット装置の制御装置においては、侵入物体を包括する警戒領域を設定し、この警戒領域及びマニピュレータの可動領域を包括する警戒領域の少なくとも一方について、これら警戒領域よりも狭い危険領域を設定して多重化し、侵入物体領域とマニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、さらに減速して第２段階の減速を行うので、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避することができ、このとき、マニピュレータが減速されているので、マニピュレータの動作状態を正確に特定することが容易となる。
【００５０】
構成８を有する本発明に係るロボット装置の制御方法においては、マニピュレータの可動領域を包括し可動領域よりも広い領域であって侵入物体の侵入が可能である警戒領域に対する侵入物体の侵入を監視し、警戒領域内への侵入物体の侵入が検知された場合には、マニピュレータの動作を減速させ、マニピュレータの可動領域内への侵入物体の侵入が検知されるとともにマニピュレータと侵入物体との距離が所定の距離以下となったときには、マニピュレータの動作を停止させる。
【００５１】
したがって、このロボット装置の制御方法においては、侵入物体がマニピュレータに接近して警戒領域内へ侵入しても、いきなりマニピュレータが停止することなく、まず、マニピュレータが減速される。このときに、侵入物体をマニピュレータから遠ざけることができれば、マニピュレータを停止させることがないので、ダウンタイムを最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。
【００５２】
そして、侵入物体がマニピュレータの可動領域内に侵入するとともに、マニピュレータと侵入物体との距離が所定の距離以下となったときに、マニピュレータの動作が停止されるので、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。また、このときには、マニピュレータが減速されているので、マニピュレータの動作状態を正確に特定することが容易となる。
【００５３】
構成９を有する本発明に係るロボット装置の制御方法においては、侵入物体の監視結果に基づいて侵入物体を包絡する第１の近似立体を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を確実に判別することができる。
【００５４】
構成１０を有する本発明に係るロボット装置の制御方法においては、侵入物体の監視結果に基づいて侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００５５】
構成１１を有する本発明に係るロボット装置の制御方法においては、侵入物体の監視結果に基づいて侵入物体の中心点を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００５６】
構成１２を有する本発明に係るロボット装置の制御方法においては、侵入物体の監視結果に基づいて侵入物体の水平面への投影図形の中心点及び水平面上において中心点から一定の距離の点を包絡した近似図形を設定するとともに、マニピュレータを監視することによりマニピュレータの動作状態を特定しマニピュレータの水平面への投影図形を設定し、これら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００５７】
構成１３を有する本発明に係るロボット装置の制御方法においては、マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、警戒領域、近似立体、または、近似図形を拡大するので、マニピュレータがワークを把持している場合においても、マニピュレータと侵入物体との接近を容易に判別することができ、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。
【００５８】
すなわち、本発明は、マニピュレータと人との干渉、接触が確実に防止され、安全が確保されつつ、装置のダウンタイムが減少され、稼働効率が低下しないようになされたロボット装置の制御装置及びロボット装置の制御方法を提供することができるものである。
【００５９】
構成１４を有する本発明に係るロボット装置の制御方法においては、侵入物体を包括する警戒領域を設定し、この警戒領域及びマニピュレータの可動領域を包括する警戒領域の少なくとも一方について、これら警戒領域よりも狭い危険領域を設定して多重化し、侵入物体領域とマニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、さらに減速して第２段階の減速を行うので、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避することができ、このとき、マニピュレータが減速されているので、マニピュレータの動作状態を正確に特定することが容易となる。
【図面の簡単な説明】
【００６０】
【図１】本発明に係るロボット装置の制御装置の構成を示す模式的な側面図である。
【図２】本発明に係るロボット装置の制御装置において実施される本発明に係るロボット装置の制御方法の手順を示すフローチャートである。
【図３】マニピュレータがワークを把持した状態における本発明に係るロボット装置の制御装置の構成を示す模式的な側面図である。
【図４】本発明に係るロボット装置の制御装置の第２の実施の形態における構成を示す模式的な側面図である。
【図５】本発明に係るロボット装置の制御装置の第３の実施の形態における構成を示す模式的な側面図である。
【図６】侵入物体領域を多重化した第５の実施の形態を示す側面図である。
【図７】本発明に係るロボット装置の制御装置の第６の実施の形態における構成を示す模式的な側面図及び平面図である。
【図８】本発明に係るロボット装置の制御装置の第６の実施の形態における他の構成を示す模式的な平面図である。
【図９】本発明に係るロボット装置の制御装置の第７の実施の形態における構成を示す模式的な側面図及び平面図である。
【図１０】本発明に係るロボット装置の制御装置の第８の実施の形態における構成を示す模式的な側面図及び平面図である。
【発明を実施するための形態】
【００６１】
以下、本発明を実施するための形態について図面を参照して説明する。
【００６２】
〔ロボット装置の制御装置の構成（第１の実施の形態）〕
図１は、本発明に係るロボット装置の制御装置の構成を示す模式的な側面図である。
【００６３】
本発明に係るロボット装置の制御装置が制御するロボット装置は、加工、組立、ワークハンドリング、溶接、塗装等を行うものである。このロボット装置は、図１に示すように、ロボット基台部４と、このロボット基台部４上に設置されたマニピュレータ１とを有し、このマニピュレータ１により、作業対象（ワーク）の把持、運搬、加工及び他の部材への組立などの操作が可能となされている。また、このロボット装置においては、マニピュレータ１の可動領域内には、作業のために人が侵入することが前提とされている。
【００６４】
マニピュレータ１は、複数のアクチュエータ（駆動装置）とリンク（剛体の構造物）とによって構成されている。すなわち、各リンク間は、回動（屈曲）、または、旋回可能な関節２ａ，２ｂ，２ｃ，２ｄ，２ｅ，２ｆを介して接続されており、それぞれアクチュエータによって相対駆動されるようになっている。各アクチュエータは、制御手段を構成するロボット制御装置３によって制御される。
【００６５】
このマニピュレータ１において、第１のリンク（基端部のリンク）１ａは、ロボット基台部４に対し、第１の関節２ａを介して接続されて設置されている。第１の関節２ａは、鉛直軸（ｚ軸）回りに旋回可能な関節である。この第１のリンク１ａの先端側には、第２の関節２ｂを介して、第２のリンク１ｂの基端側が接続されている。第２の関節２ｂは、水平な軸回りに第２のリンク１ｂを回動可能とする関節である。第２のリンク１ｂの先端側には、第３の関節２ｃを介して、第３のリンク１ｃの基端側が接続されている。第３の関節２ｃは、水平な軸回りに第３のリンク１ｃを回動可能とする関節である。
【００６６】
そして、第３のリンク１ｃの先端側には、第４の関節２ｄを介して、第４のリンク１ｄの基端側が接続されている。第４の関節２ｄは、第３のリンク１ｃの軸回りに第４のリンク１ｄを回動可能とする関節である。第４のリンク１ｄの先端側には、第５の関節２ｅを介して、第５のリンク１ｅの基端側が接続されている。第５の関節２ｅは、水平な軸回りに第５のリンク１ｅを回動可能とする関節である。第５のリンク１ｅの先端側（手先）には、第６の関節２ｆを介して、作業対象を把持したり加工したりする先端ツール機構５が設けられている。この先端ツール機構５は、ロボット制御装置３によって制御される。
【００６７】
ロボット制御装置３は、マニピュレータ１の動作状態、すなわち、マニピュレータ１の各アクチュエータの移動速度及び移動方向を制御し、また、マニピュレータ１の減速、一時停止、非常停止等の動作モードを制御する。また、ロボット制御装置３は、マニピュレータ１に対する制御情報、すなわち、各関節２ａ，２ｂ，２ｃ，２ｄ，２ｅのアクチュエータに対する動作指令情報やツール機構５に対する動作指令情報に基づいて、各関節２ａ，２ｂ，２ｃ，２ｄ，２ｅの角度やツール機構５の把持情報などを取得し、マニピュレータ１やツール機構５の動作状態を特定することができる。なお、マニピュレータ１は垂直多関節型に限らず、円筒座標型，極座標型，直交座標型，水平多関節型などさまざなまな形態が考えられる。
【００６８】
また、ロボット装置を制御するロボット制御装置３の上位制御装置として、ロボット制御装置やツール機構に指令やシーケンスを与えるために統括制御装置としてＰＬＣなどが用いられることも多く、これらを介して、マニピュレータ１やツール機構５の動作状態を取得することも可能である。
【００６９】
そして、本発明に係るロボット装置の制御装置においては、マニピュレータ１の可動領域Ａを包括し可動領域Ａよりも広い領域であって侵入物体（例えば、作業者）１０１の侵入が可能である警戒領域Ｂが設定されている。
【００７０】
このロボット装置の制御装置は、警戒領域Ｂに対する侵入物体１０１の侵入を監視する侵入検知手段となる３次元センサ６を備えている。この３次元センサ６としては、例えば、レーザレーダやステレオカメラ等を使用することができる。この３次元センサ６は、マニピュレータ１の上方に設置することが好ましい。この３次元センサ６は、警戒領域Ｂよりも広い計測領域Ｃ内の物体までの距離を測定することができ、この測定結果に基づいて、警戒領域Ｂ内の物体を３次元計測することができる。
【００７１】
３次元センサ６による計測結果を示す計測データは、制御手段を構成する安全監視装置７に送られる。この安全監視装置は、３次元センサ６から送られた計測データと、ロボット制御装置３から送られるマニピュレータ１に対する制御情報（関節角情報や把持情報等）とに基づいて、侵入物体１０１とマニピュレータ１との間の距離を算出する。そして、安全監視装置は、侵入物体１０１とマニピュレータ１との間が所定の距離以下となっている場合には、ロボット制御装置３に対して、減速や非常停止を指示する動作指令を送る。ロボット制御装置３は、安全監視装置７から動作指令が送られると、この動作指令に従って、マニピュレータ１の動作を減速させたり、または、停止させる。
【００７２】
〔ロボット装置の制御方法（第１の実施の形態）〕
本発明に係るロボット装置の制御方法は、本発明に係るロボット装置の制御装置を動作させることによって実施される。このロボット装置の制御方法は、ロボット装置の通常の運転中だけではなく、調整、試験、メンテナンス、教示、検査等を含む種々の作業中にも実施することができる。
【００７３】
ロボット装置の制御装置において、安全監視装置７及びロボット制御装置３は、３次元センサ６により、警戒領域Ｂ内への侵入物体１０１の侵入が検知された場合には、マニピュレータ１の動作を減速させ、マニピュレータ１の可動領域Ａ内への侵入物体１０１の侵入が検知されるとともに、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったときには、マニピュレータ１の動作を停止させる。
【００７４】
図２は、本発明に係るロボット装置の制御装置において実施される本発明に係るロボット装置の制御方法の手順を示すフローチャートである。
【００７５】
すなわち、このロボット装置の制御装置において、安全監視装置７及びロボット制御装置３は、図２に示すように、所定の処理を、サイクル毎、もしくは、逐次処理にて実行する。なお、この処理の開始時には、警戒領域Ｂ及び可動領域Ａ内には、図１に示すように、周辺機器等の固定物体１０２の他には、侵入物体１０１が侵入していないものとする。
【００７６】
図２のステップｓｔ１において、処理をスタートすると、ステップｓｔ２に進み、３次元センサ６からの計測データから、計測領域Ｃ内における固定物体１０２及びマニピュレータ１のデータを削除する。ここで、３次元センサ６とマニピュレータ１との位置関係が予めキャリブレーションされているものとし、安全監視装置７は、３次元センサ６からの計測データと同期したタイミング（同時刻）で、ロボット制御装置３から、マニピュレータ１の関節角情報などの制御情報を取得する。なお、これら計測データと制御情報とは、実際に同時刻に取得されなくとも、それぞれにタイムスタンプ情報が付加されていれば、このタイムスタンプ情報により、同期したデータとして処理することができる。また、それぞれが同期しないタイミングでデータを取得する場合には、最大となる同期ズレ時間分で考えられる互いの移動量を考慮して、後に設定する安全距離などに反映することが考えられる。
【００７７】
次に、ステップｓｔ３に進み、計測領域Ｃ内における侵入物体１０１の有無を判別する。侵入物体１０１が検出された場合には、ステップｓｔ４に進み、侵入物体１０１が検出されない場合には、ステップｓｔ２に戻る。
【００７８】
ここで、マニピュレータ１は動作するため、マニピュレータ１と侵入物体１０１とは、計測データにおいては同様の動体となってしまうため、これらを判別する必要がある。そこで、マニピュレータ１の構造は予め分かっているので、関節などの配置を考慮して、マニピュレータ１を複数の球などの第２の近似立体で包絡した領域（以下、「マニピュレータ領域」という。）を設定する。この領域の情報に関節角度などの制御情報を与えることにより、計測データ取得時におけるマニピュレータ領域を求めることができる。計測データとマニピュレータ１の制御情報とは同期したデータとして処理できるため、計測データとマニピュレータ領域とを付き合わせて処理をすることにより、計測データから、マニピュレータ１の動作を分離し削除することができる。
【００７９】
同様に、事前に取得、または、設定された計測領域Ｃ内に存在する固定物体１０２の包絡領域データを利用し、もしくは、前回の計測から変化がない部分を固定物体１０２とみなして、これを計測データから削除することにより、計測データから、固定物体１０２を分離し削除することができる。
【００８０】
このようにして、計測領域Ｃ内に存在する侵入物体１０１を抽出することができる。このとき、例えば、ロボット制御装置３から得られたデータに異常があり、現実のマニピュレータ１の動作と合致しない場合には、データの付き合せにより、マニピュレータ１の動作を分離することができないので、マニピュレータ１の近傍の領域内に、侵入物物体１０１が突然現れたように判別されることになる。このような場合には、ロボット制御装置３からのデータが異常であると判別して、マニピュレータ１を非常停止させるようにしてもよい。
【００８１】
ステップｓｔ４では、侵入物体１０１が警戒領域Ｂ内に侵入しているかを判別し、警戒領域Ｂ内に侵入していればステップｓｔ５に進み、警戒領域Ｂ内に侵入していなければステップｓｔ２に戻る。
【００８２】
計測領域Ｃ内には、前述したように、警戒領域Ｂが設定されている。警戒領域Ｂは、マニピュレータ１の可動領域Ａを包括し可動領域Ａよりも広い領域であり、侵入物体１０１の侵入が可能な領域である。なお、可動領域Ａ内であっても、侵入物体１０１の侵入があり得ない領域は、警戒領域Ｂに含める必要はなく、計測領域Ｃに含める必要もない。図１においては、警戒領域Ｂは、３次元センサ６から放射状に設定されており、可動領域Ａより大きく包絡される床付近の部分をカットしている。
【００８３】
ステップｓｔ５では、安全監視装置７は、抽出された侵入物体１０１のデータから、侵入物体１０１を含む領域（以下、「侵入物体領域」という。）を設定する。すなわち、侵入物体１０１から安全距離を隔てた位置までの領域を、球、円筒、立方体を含む正多面体等の第１の近似立体で包絡して、侵入物体領域を設定する。または、侵入物体１０１を人と想定し、侵入物体１０１の中央と考えられる位置から、人が手足を伸ばした場合に届く範囲に安全距離分を加えた領域を近似立体で包絡して、侵入物体領域を設定する。なお、具体的な侵入物体領域の設定としては、侵入物体１０１のデータのうち、最上点（頂点）から床面まで垂線を降ろし、この垂線の中点を侵入物体１０１の中心とし、この中心から人が飛び出さないであろう半径を設定した球を設定することなどが考えられる。
【００８４】
これら近似立体としては、球、円筒、多面体等、どのような形状であってもよいが、侵入物体として想定される人と、マニピュレータとを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似立体は、複数の立体が組合わさったものであってもよい。
【００８５】
次のステップｓｔ６では、前述したように、マニピュレータ領域を設定し、ステップｓｔ７に進む。
【００８６】
ステップｓｔ７では、マニピュレータ領域と侵入物体領域との干渉の有無を判別する。各領域の干渉がある場合には、ステップｓｔ９に進み、各領域の干渉がない場合には、ステップｓｔ８に進む。
【００８７】
ステップｓｔ８では、安全監視装置７は、マニピュレータ１の動作速度を安全な速度に落とすような減速指令をロボット制御装置３に送り、マニピュレータ１を減速させ、ステップｓｔ２に戻る。このとき、マニピュレータ１は停止せず、マニピュレータ１による作業も停止しない。安全な速度とは、例えば、ＩＳＯ１０２１８−１に規定されているように、産業用ロボットと人とが共存可能な速度の上限である２５０ｍｍ／sec以内の速度で、事前のリスクアセスメントなどによって決定される。
【００８８】
そして、ステップｓｔ９では、安全監視装置７は、ロボット制御装置３に対して、非常停止指令を送り、マニピュレータ１を非常停止させ、ステップｓｔ１０に進んで処理を終了する。
【００８９】
このようなロボット装置の制御方法において、最大サイクル時間、マニピュレータの移動最大速度や、警戒領域Ｂ、マニピュレータ領域及び侵入物体領域等の各領域間の余裕等は、侵入物体１０１とマニピュレータ１との接触状況を十分に想定、勘案して、決定される。例えば、マニピュレータ１の移動速度を早く設定したい場合には、サイクル時間を短くし、各領域間の余裕を大きくとることが望ましい。また、非常停止指令が発信されてから、実際にマニピュレータ１が停止するまでの移動距離（安全距離）等も考慮するとよい。
【００９０】
図３は、マニピュレータがワークを把持した状態における本発明に係るロボット装置の制御装置の構成を示す模式的な側面図である。
【００９１】
図３に示すように、マニピュレータ１がワーク１０３を把持した場合には、ワーク１０３が大きいと、ワーク１０３を把持したマニピュレータ１の可動領域Ａ´は、把持していないマニピュレータ１のみの可動領域Ａに比べて、大きくなる。この場合、安全監視装置７は、ロボット制御装置３から、マニピュレータ１がワーク１０３を把持しているか否かの情報を取得し、この情報により、警戒領域Ｂを拡大して新たな警戒領域Ｂ´とし、マニピュレータ領域も拡大することにより、マニピュレータ１及びワーク１０３と侵入物体１０１との接触を防止し、ダウンタイムを低減させることができる。
【００９２】
このように、本発明に係るロボット装置の制御装置及びロボット装置の制御方法においては、マニピュレータ１の可動領域Ａの内部への侵入物体１０１の侵入を常時監視しているので、従来のような入退扉の開閉により制御するロボット装置に比較して、フールプルーフな対策となっており、さらに、マニピュレータ１と侵入物体１０１との位置関係から、これらの接触、干渉の虞があるときには、マニピュレータ１を安全速度に減速し、さらに、必要な場合のみに非常停止させる。
【００９３】
本発明においては、侵入物体１０１のマニピュレータ１に対する接近により、いきなり非常停止するのではなく、まず、マニピュレータ１の減速がなされ、このときには、作業そのものは続行される。そのため、作業者（侵入物体１０１）がマニピュレータ１との接触を避けるための時間が確保できるとともに、接触を避ければ非常停止を回避することができるので、装置のダウンタイムを削減することができる。
【００９４】
すなわち、本発明においては、ロボット制御装置３からマニピュレータ１に対する制御情報を取得し、または、３次元センサ６による計測結果から、マニピュレータ１の位置、挙動と侵入物体１０１の位置、挙動を分離して判別し、これらの接触可能性を監視するため、例えば、マニピュレータ１と作業者との間に十分な安全距離があるような場合に、うっかり可動領域Ａに踏み込むケースや、ワークの位置ずれなどを直す等の短時間の作業のかめに可動領域Ａに侵入するなどしても、非常停止にならず、マニピュレータ１は稼動を続けるので、ダウンタイムの発生を極力少なくすることができる。また、このような状況で、作業者の思い違いや、作業時間の見込み違い、作業者のロボット装置に対する理解不足などにより、マニピュレータ１との接触の危険性が発生しても、マニピュレータ１は、作業者と接触する前に非常停止する。
【００９５】
このように、本発明においては、マニピュレータ１の可動領域Ａに侵入物体１０１が侵入したという理由だけでは非常停止しないので、非常停止によるダウンタイムなど、稼働効率の低下要因を極力排除し、ロボット装置を高効率に運用することができる。
【００９６】
また、マニピュレータ１が減速されたときには、マニピュレータ１の動作と侵入物体１０１の分離処理などの情報処理が容易となり、その後に行われるマニピュレータ１の可動領域Ａ内における侵入物体１０１の認識処理も容易となる。例えば、３次元センサ６としてレーザレンジファインダなどを利用した場合には、走査して計測をおこなうため、計測対象が高速で動く場合には、移動を伴うデータとして記録される。そのため、計測対象が高速移動すると、侵入物体１０１の位置を正確に同定し、マニピュレータ１と侵入物体１０１とを精密に分離する処理が困難になる。マニピュレータ１が減速されることにより、侵入物体１０１の位置を正確に同定できるようになり、マニピュレータ１と侵入物体１０１とを精密に分離する処理が可能となる。
【００９７】
さらに、本発明においては、マニピュレータ１が物品を弾き飛ばしたりするような作業を行う場合でなければ、マニピュレータ１の周囲に安全柵を設置しなくとも、十分に安全性を確保することができる。安全柵を設置せずに済めば、敷地の有効活用ができ、ロボット装置を使用するうえでの制約条件が低減され、コスト低減も期待できる。
【００９８】
〔第２の実施の形態〕
図４は、本発明に係るロボット装置の制御装置の第２の実施の形態における構成を示す模式的な側面図である。
【００９９】
前述の実施の形態においては、侵入検知手段として、１台の３次元センサ６を使用しているが、図４中の（ａ）に示すように、周辺装置などの固定物体１０２の位置によっては、３次元センサ６に死角が生ずる場合もある。このような死角をなくし、また、計測領域Ｃをより広範囲とするため、図４中の（ｂ）に示すように、複数の３次元センサ６を統合して使用するようにしてもよい。
【０１００】
すなわち、このロボット装置の制御装置においては、侵入検知手段として、２台の３次元センサ６ａ，６ｂを使用している。この制御装置においては、第１及び第２の３次元センサ６ａ，６ｂのそれぞれについて、計測領域Ｃ１，Ｃ２が設定されており、これら各計測領域Ｃ１，Ｃ２のいずれかに侵入した侵入物体１０１が計測される。また、各計測領域Ｃ１，Ｃ２について、それぞれ警戒領域Ｂ１，Ｂ２が設定される。これら各警戒領域Ｂ１，Ｂ２のいずれかに属する領域が、警戒領域Ｂとなる。
【０１０１】
このロボット装置の制御装置においては、３次元センサ６が１台の場合には固定物体１０２の死角に入ってしまっていた侵入物体１０１ｂが、一方の３次元センサ６ｂによっては計測されており、警戒領域Ｂに接近していることが検知される。
【０１０２】
〔第３の実施の形態〕
図５は、本発明に係るロボット装置の制御装置の第３の実施の形態における構成を示す模式的な側面図である。
【０１０３】
前述の実施の形態においては、マニピュレータ１を１台有するロボット装置を制御対象としているが、図５に示すように、複数のマニピュレータ１，１を有するロボット装置、または、複数のロボット装置を制御対象としてもよい。
【０１０４】
すなわち、ロボット装置は、同一のセル（同一領域）において、複数台が同時に稼働する場合がある。このような場合には、安全監視装置７が複数台のロボット制御装置３，３、もしくは、これらを統括管理する制御装置からデータを取得して、前述の実施の形態と同様にして、複数のマニピュレータ１，１に対する減速指令や非常停止指令を発するようにしてもよい。
【０１０５】
また、可動領域Ａ内に存在する周辺装置などに、人に危害を与え得るような可動部が設けられている場合には、これを第２、第３のロボットと考えて、ロボット装置と同様の制御を行うことができる。この場合には、安全監視装置７は、その周辺装置の制御装置、または、複数の制御装置を統括管理する制御装置からデータを取得して、前述の実施の形態と同様にして、マニピュレータ１及び周辺装置に対する減速指令や非常停止指令を発する。
【０１０６】
さらに、ロボット装置が同一のセル内に存在しない他の機器と連動して動作する場合には、安全監視装置７は、それら他の機器に対しても、減速指令や非常停止指令を発するようにするとよい。この場合には、ロボット装置と他の機器との連動した作業を円滑に継続させることができる。
【０１０７】
同様に、溶接や塗装などの自動作業を行う工程では、ロボットの動作のみが減速され一時停止されると、溶接や塗装などの品質に対して致命的なダメージを与えることが考えられるため、溶接装置の制御装置や塗装ガンの制御装置などに対しても、速度調整、一時停止指令を行うように構成することが好ましい。この場合には、安全監視装置７は、溶接装置の制御装置や塗装ガンの制御装置、または、これら制御装置を統括管理する制御装置からデータを取得して、前述の実施の形態と同様にして、マニピュレータ１及び溶接装置、または、塗装ガンに対する減速指令や非常停止指令を発する。
【０１０８】
なお、実際の運用を考えると、本発明において使用される３次元センサ６や安全監視装置７には、必要な安全対策、例えば、２重化や自己診断などの措置が取られていることが必要である。また、マニピュレータ１についても、減速や非常停止に関する部分については、同様の対策がなされていることが望ましい。例えば、ロボット装置の内部位置センサ周辺部や、減速及び非常停止指令の受付部などである。また、安全監視装置７及び３次元センサ６は、電源が切れている場合等、正常に起動していない状態においては、フェールセーフのため、ロボット制御装置３に対して、非常停止指令を出し続けている状態とする必要がある。
【０１０９】
〔第４の実施の形態〕
前述の実施の形態においては、侵入検知手段となる３次元センサ６して、レーザレーダ（レーザレンジファインダ）を例示しているが、３次元センサ６としては、ステレオカメラ等を用いることもできる。
【０１１０】
また、警戒領域Ｂを精密に設定するには、３次元センサは有効であるが、侵入物体領域とマニピュレータ領域との干渉を監視することについては、他のセンサの使用も考えられる。例えば、２次元センサの組み合わせにより３次元情報を取得する構成や、２次元センサと既知の情報との組み合わせにより、３次元情報として扱う手法などが考えられる。侵入物体１０１を作業者であると想定した場合には、通常のカメラを用いて作業者の頭部を画像処理により認識し、この情報に既知の人体のサイズを組み合わせることにより、侵入物体１０１（作業者）の中心位置を特定することができる。
【０１１１】
さらに、侵入検知手段となるセンサとしては、赤外線飛行時間計測方式の３次元距離測定装置や、マイクロ波センサ、超音波センサなどを使用することができる。また、複数台のカメラを作業環境の周囲に配置することによる立体映像取得方法（視体積交差法）も使用することができる。さらに、これら種々のセンサ及び手法を組み合わせて使用することもできる。
【０１１２】
〔第５の実施の形態〕
図６は、侵入物体領域を多重化した第５の実施の形態を示す側面図である。
【０１１３】
また、本発明においては、図６に示すように、侵入物体１０１を包括する侵入物体領域を、警戒領域と一、または、二以上に多重化された危険領域とに多重化してもよい。同様に、マニピュレータ領域についても、多重化してもよい。この場合には、侵入物体１０１とマニピュレータ１との接近状況を多段的に認識することができ、これらの接近に応じて、マニピュレータ１の速度を順次多段的にに減速させることができる。すなわち、侵入物体領域とマニピュレータ領域との警戒領域同士が重なった場合には、第１段階の減速を行い、一方の領域の危険領域と他方の領域の警戒領域とが重なった場合には、さらに減速して第２段階の減速を行い、各領域の危険領域同士が重なった場合以降は、第３段階以降の原則を順次行い、最後は非常停止を行うなどの制御が可能となる。この場合には、適宜の設定を行うことにより、ダウンタイムの発生を最小限とすることができる。
【０１１４】
〔第６の実施の形態〕
図７は、本発明に係るロボット装置の制御装置の第６の実施の形態における構成を示す模式的な側面図及び平面図である。
【０１１５】
本発明に係るロボット装置の制御装置においては、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったときに、マニピュレータ１と侵入物体１０１との位置関係の判定は、図７中の（ｂ）に示すように、マニピュレータ１及び侵入物体１０１の水平面への投影図形を包絡する近似図形を設定することによって行ってもよい。
【０１１６】
この場合、安全監視装置７は、侵入検知手段による検知結果に基づいて、侵入物体１０１の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータ１の構造及びマニピュレータ１に対する制御情報に基づいて、マニピュレータ１の動作状態を特定し、このマニピュレータ１の水平面への投影図形を包絡する第２の近似図形を設定する。そして、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったことを判別する。ここで、侵入検知手段は、図７中の（ａ）に示すように、３次元センサであってもよいし、２次元センサであってもよい。
【０１１７】
すなわち、安全監視装置７は、まず、侵入物体１０１と判断される領域を水平面（床面）に投影した形状を特定し、この形状の中央の点（図心等）を代表点をし、この代表点を中心として、侵入物体１０１と判断される領域の投影図形を包絡する領域として、例えば、人のリーチが届く範囲に安全距離分などを加えた領域を第１の近似図形を設定し、侵入物体領域とする。この第１の近似図形は、例えば、円や長方形等とするとよい。
【０１１８】
次に、安全監視装置７は、マニピュレータ１の構造及び関節などの配置に基づいて予め設定された代表点と、ロボット制御装置３より取得した制御情報とから、空間に位置付けられる各代表点を水平面（床面）に投影した点を中心として、マニピュレータ１と判断される領域の投影図形を包絡する領域として、第２の近似図形を設定し、マニピュレータ領域とする。この第２の近似図形は、例えば、複数の円からなるものとするとよい。
【０１１９】
そして、安全監視装置７は、データ取得時において、これらマニピュレータ領域及び侵入物体領域の干渉の有無を判別し、干渉があった場合には、ロボット制御装置３に対して、非常停止指令を発信し、マニピュレータ１を非常停止させる。
【０１２０】
なお、近似図形としては、円、正方形を含む多角形等、どのような形状であってもよいが、侵入物体１０１として想定される人の投影図形と、マニピュレータ１の投影図形とを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。マニピュレータ１の投影図形を包絡する第２の近似図形は、複数の図形が組合わさったものであってもよい。近似図形を円とすると、中心から等距離の点の集合であるという円の性質から、干渉の有無の判別を容易に行うことができる。
【０１２１】
図８は、本発明に係るロボット装置の制御装置の第６の実施の形態における他の構成を示す模式的な平面図である。
【０１２２】
このロボット装置の制御装置おいて、侵入検知手段を２次元センサとする場合には、図８中の（ａ）及び（ｂ）に示すように、２次元センサ６ｃは、マニピュレータ１の上方に設置する必要はなく、ロボット基台部４の周囲部に設置し、このロボット基台部４の周囲における物体の有無を検出するセンサとしてもよい。これら２次元センサ６ｃにより、図８中の（ｃ）に示すように、侵入物体１０１の下部、すなわち、侵入物体１０１が人であれば、足首部分が検知される。このようにして侵入物体１０１の下部が検知された場合には、安全監視装置７は、これを人であると想定して、検知された位置を中心として、予め設定した高さ（例えば、人の平均身長）の侵入物体１０１が存在するものと判別する。侵入物体１０１の存在が判別されれば、この侵入物体１０１に基づいて、近似立体や近似図形を設定することにより、前述の実施の形態と同様にして、この侵入物体１０１とマニピュレータ１との接近、干渉を判別することができる。
【０１２３】
〔第７の実施の形態〕
図９は、本発明に係るロボット装置の制御装置の第７の実施の形態における構成を示す模式的な側面図及び平面図である。
【０１２４】
本発明に係るロボット装置の制御装置においては、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったとき、マニピュレータ１と侵入物体１０１との位置関係の判定は、図９中の（ａ）及び（ｂ）に示すように、３次元センサ６による検知結果に基づいて侵入物体１０１の中心点を設定し、マニピュレータ１の構造及びマニピュレータ１に対する制御情報に基づいてマニピュレータ１の動作状態を特定し、このマニピュレータ１の複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより行ってもよい。
【０１２５】
すなわち、安全監視装置７は、まず、侵入物体１０１と判断される領域の中心点を設定する。中心点の設定は、侵入物体１０１を人と想定した場合には、侵入物体１０１の最頂点、すなわち、人の頭部中央から床面に垂線を降ろし、この垂線の中点を中心点と設定することができる。
【０１２６】
次に、安全監視装置７は、マニピュレータ１の構造及び関節などの配置に基づいて予め設定された代表点と、ロボット制御装置３より取得した制御情報とから、空間に位置付けられる各代表点を設定する。
【０１２７】
そして、安全監視装置７は、データ取得時において、これら侵入物体１０１の中心点及びマニピュレータ１の各代表点の間の距離を判別し、この距離が所定の距離、例えば、安全距離以下となった場合には、ロボット制御装置３に対して、非常停止指令を発信し、マニピュレータ１を非常停止させる。ここで、安全距離は、マニピュレータ１の移動速度をパラメータとする変数として設定してもよい。例えば、マニピュレータ１の移動速度が速い場合には、安全距離を長くし、マニピュレータ１の移動速度が遅い場合には、安全距離を短くするように設定することにより、装置のダウンタイムの発生及び作業効率の低下を防止することができる。
【０１２８】
なお、侵入物体１０１の中心点及びマニピュレータ１の各代表点の間の距離の判別は、これら中心点及び各代表点を水平面（床面）に投影した投影点を設定し、これら各投影点の水平面上における距離を判別するようにしてもよい。
【０１２９】
また、侵入物体１０１の中心点及びマニピュレータ１の各代表点の間の距離の判別においては、マニピュレータ１の各代表点について、先端側ほど高い重み付けを設定し、先端部の影響を高めたうえで、判別するようにしてもよい。これは、マニピュレータ１は、形態にもよるが、一般的に先端ほど高速、かつ、予想し得ない多方向に動き、人との接触は、マニピュレータ１の先端部分において発生しやすいからである。
【０１３０】
〔第８の実施の形態〕
図１０は、本発明に係るロボット装置の制御装置の第８の実施の形態における構成を示す模式的な側面図及び平面図である。
【０１３１】
本発明に係るロボット装置の制御装置においては、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったときに、マニピュレータ１と侵入物体１０１との位置関係を判定する方法としては、図１０中の（ｂ）に示すように、侵入物体１０１の水平面への投影図形を包絡する近似図形と、マニピュレータ１の水平面への投影図形を設定することによって行ってもよい。
【０１３２】
この場合、安全監視装置７は、侵入検知手段による検知結果に基づいて、侵入物体１０１の水平面への投影図形を包絡する第１の近似図形を設定する。また、安全監視装置７は、侵入検知手段による検知結果に基づいて、マニピュレータ１の水平面への投影図形を設定する。そして、これら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったことを判別する。ここで、侵入検知手段は、図１０中の（ａ）に示すように、３次元センサであってもよいし、２次元センサであってもよい。
【０１３３】
すなわち、安全監視装置７は、まず、侵入物体１０１と判断される領域を水平面（床面）に投影した形状を特定し、この形状の中央の点（図心等）を代表点とし、この代表点を中心として、侵入物体１０１と判断される領域の投影図形を包絡する領域として、例えば、人のリーチが届く範囲に安全距離分などを加えた領域を近似図形を設定し、侵入物体領域とする。
【０１３４】
この近似図形としては、円、正方形を含む多角形等、どのような形状であってもよいが、侵入物体１０１として想定される人の投影図形と、マニピュレータ１の投影図形とを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することがが好ましい。マニピュレータ１の投影図形を包絡する第２の近似図形は、複数の図形組合わさったものであってもよい。近似図形を円とすると、中心から等距離の点の集合であるという円の性質から、干渉の有無の判別を容易に行うことができる。
【０１３５】
次に、安全監視装置７は、侵入検知手段によりマニピュレータ１と判断される領域を水平面（床面）に投影した投影図形を設定する。
【０１３６】
そして、安全監視装置７は、データ取得時において、これら侵入物体領域及びマニピュレータ１の投影図形の干渉の有無を判別し、干渉があった場合には、ロボット制御装置３に対して、非常停止指令を発信し、マニピュレータ１を非常停止させる。
【０１３７】
この場合には、安全監視装置７は、ロボット制御装置３から、マニピュレータ１に対する制御情報を取得する必要はない。
【産業上の利用可能性】
【０１３８】
本発明は、ロボット装置の制御装置及びロボット装置の制御方法に適用され、ロボット装置のマニピュレータの可動領域に人などが侵入した場合の保安、安全の向上を図ることができる。
【符号の説明】
【０１３９】
１ マニピュレータ
３ ロボット制御装置
４ ロボット基台部
５ 先端ツール機構
６ ３次元センサ
７ 安全監視装置
１０１ 侵入物体
【技術分野】
【０００１】
本発明は、ロボット装置の制御装置及びロボット装置の制御方法に関し、ロボット装置のマニピュレータの可動領域に人などが侵入した場合の保安、安全の向上を図ったロボット装置の制御装置及びロボット装置の制御方法に関する。
【背景技術】
【０００２】
従来、マニピュレータを備えたロボット装置が提案されている。このようなロボット装置においては、マニピュレータの可動領域に人などが侵入する可能性がある。このような場合の保安、安全を図るため、従来のロボット装置においては、マニピュレータの可動領域の外側に、入退扉を有する安全柵等を設置することが行われている。そして、この安全柵の入退扉に開閉状態を検出するスイッチを設けておき、あるいは、ライトカーテン等により、いわば出入口管理により、安全柵内への人の侵入を検知するようにしている。ロボット装置の制御装置は、安全柵内への人等の侵入が検知された場合には、ロボット装置への駆動電源の供給を遮断し、ロボット装置を非常停止させるようになっている。
【０００３】
また、特許文献１には、人とマニピュレータとの接触可能性のあるエリアを限定し、このエリアを重点的にカメラにより監視しておき、状況に応じて、マニピュレータの動作を減速させ、あるいは、非常停止させるようにしたロボット装置が記載されている。
【０００４】
特許文献２には、カメラ等による監視を行い、侵入者を検出した場合には、警告を発するようにしたロボット装置が記載されている。
【０００５】
特許文献３には、カメラ等による監視を行い、侵入者を検出した場合には、侵入者の位置及び速度等の状況を分析し、マニピュレータとの接触可能性のある領域との位置及び速度等の関係から、マニピュレータの動作を減速させ、あるいは、非常停止させるようにしたロボット装置が記載されている。
【０００６】
さらに、特許文献４には、マニピュレータを近似立体を使ってモデル化し、人等との干渉や接触を確認するようにしたロボット装置が記載されている。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】特開２００７−２８３４５０号公報
【特許文献２】特許第３７０４７０６号公報
【特許文献３】特表２００６−５０１４８７号公報
【特許文献４】特許第２６７８００５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００８】
ところで、従来のロボット装置において、入退扉の開閉状態の検出により侵入者を検知するようにした場合には、作業者の過失により、作業者が安全柵内に残っている状態で入退扉を閉めてしまった場合には、マニピュレータの非常停止状態が解除されてしまい、作業者とマニピュレータとが接触する可能性が生ずる。
【０００９】
また、このようなロボット装置においては、安全柵の内側の全ての領域がマニピュレータの可動領域というわけではないため、安全柵の設置により、ロボット装置そのものが占有する面積よりも大きな面積が占有されることになってしまい、スペース効率の低下を招くこととなる。
【００１０】
さらに、このロボット装置においては、入退扉が解放された場合には、マニピュレータと人との接触可能性がない状態や、または、接触の可能性がすぐには生じない状態であっても、ロボット装置は非常停止され、稼働効率の低下を招くこととなる。例えば、マニピュレータが安全柵の入退扉とは反対側で作業をしている状況において、マニピュレータが次に把持すべきワークの位置がずれていることが分かったとする。このままの状態で把持を行おうとすれば、マニピュレータは、把持に失敗し、停止することになる。このような状況では、マニピュレータが入退扉の付近に移動してくるには十分な時間があり、その間に作業者がワークの位置を修正することができる状況ではあるが、入退扉を解放すれば、マニピュレータは非常停止してしまうため、無駄な時間が生ずる。
【００１１】
そして、このような状況においては、作業者は、無駄な時間が生ずることを嫌って、非常停止の機能を解除してしまうことが考えられる。すなわち、入退扉を解放してもマニピュレータが非常停止しない状態として、安全柵内に侵入することが考えられる。この場合において、作業者の思い違い、見込み違いや、ロボット装置に対する理解不足などから、予想に反してマニピュレータが戻ってしまい、マニピュレータと作業者とが接触する虞が生ずる。
【００１２】
また一般的に、ロボット装置は、一旦、非常停止により駆動電源の遮断やプログラムリセット等が生じてしてしまうと、非常停止状態を確認し、解除した後に、マニピュレータを初期状態（原点位置等）に戻し、また、仕掛かり中のワークを元の位置に戻すなどしたうえで、プログラムを再始動するといった復旧作業が必要となる。そのため、多くの装置のダウンタイムが発生し、これらの作業を行うための作業員も必要となり、生産効率が大きく低下してしまう。
【００１３】
したがって、ロボット装置においては、安全の確保を前提としつつも、装置のダウンタイムを減少させ、稼働効率を低下させないことが期待される。
【００１４】
特許文献１に記載されたロボット装置においては、マニピュレータと人との接触可能性のある領域を限定できる場合には有効である。しかし、マニピュレータの可動領域を大きくした場合には、この可動領域内において人が侵入できる場所及び侵入する必要のある場所が多くなり、マニピュレータの可動領域のほぼ全体を監視しなければならなくなる。したがって、安全を確保するためには、侵入による非常停止が頻繁に発生することとなり、稼働効率の低下が招来される。
【００１５】
そのため、このロボット装置においては、人が侵入できる領域を集約しておく必要があるため、セルの設計自由度が低く、ロボットが比較的大きく動かない特定の小型セルや分割された作業エリアなどにしか適用することができない。
【００１６】
そして、特許文献２に記載されたロボット装置においては、マニピュレータの可動領域への人の侵入のみを監視しており、マニピュレータの動作については監視していない。また、特許文献３に記載されたロボット装置においても、人の挙動のみを監視対象としており、マニピュレータの動作及び挙動は監視していない。このように、これら特許文献２及び特許文献３に記載されたロボット装置においては、人の挙動のみを監視装置により監視するため、作業者の安全は確保されるが、人の侵入可能領域がマニピュレータの動作によって変化することはない。例えば、マニピュレータと作業者との間に十分な安全距離が確保されていたとしても、マニピュレータの可動領域に人が侵入するなり、マニピュレータは非常停止するので、稼働効率の低下は避けられない。
【００１７】
特許文献４に記載されたロボット装置においては、複数のマニピュレータ同士や、マニピュレータの可動領域と物品との干渉や接触を確認する方法であり、人とマニピュレータとの干渉や接触を対象としていない。
【００１８】
そこで、本発明は、前記の実情に鑑みてなされたものであり、その目的は、マニピュレータと人との干渉、接触が防止され、安全性が高まり、装置のダウンタイムが減少され、稼働効率が低下しないようになされたロボット装置の制御装置及びロボット装置の制御方法を提供することにある。
【課題を解決するための手段】
【００１９】
前述の課題を解決し、前記目的を達成するため、本発明に係るロボット装置の制御装置は、以下の構成を有するものである。
【００２０】
〔構成１〕
マニピュレータを備えたロボット装置の動作を制御するためのロボット装置の制御装置であって、マニピュレータの可動領域を包括し該可動領域よりも広い領域であって侵入物体の侵入が可能である警戒領域に対する侵入物体の侵入を監視する侵入検知手段と、マニピュレータの動作状態を特定するとともに該マニピュレータの動作を制御する制御手段とを備え、制御手段は、検知手段により、警戒領域内への侵入物体の侵入が検知された場合には、マニピュレータの動作を減速させ、マニピュレータの可動領域内への侵入物体の侵入が検知されるとともにマニピュレータと侵入物体との距離が所定の距離以下となったときには、マニピュレータの動作を停止させることを特徴とするものである。
【００２１】
〔構成２〕
構成１を有するロボット装置の制御装置において、侵入検知手段は、３次元認識センサであって、制御手段は、侵入検知手段による検知結果に基づいて侵入物体を包絡する第１の近似立体を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００２２】
これら近似立体としては、球、円筒、多面体等、どのような形状であってもよいが、侵入物体として想定される人と、マニピュレータとを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似立体は、複数の立体が組合わさったものであってもよい。
【００２３】
〔構成３〕
構成１を有するロボット装置の制御装置において、侵入検知手段は、２次元認識センサ、または、３次元認識センサであって、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００２４】
これら近似図形としては、円、多角形等、どのような形状であってもよいが、侵入物体として想定される人の投影図形と、マニピュレータの投影図形とを、無駄なく包絡できる形状で、かつ、近似図形同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似図形は、複数の図形が組合わさったものであってもよい。
【００２５】
〔構成４〕
構成１を有するロボット装置の制御装置において、侵入検知手段は、３次元認識センサであって、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の中心点を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００２６】
〔構成５〕
構成１を有するロボット装置の制御装置において、侵入検知手段は、２次元認識センサ、または、３次元認識センサであって、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の水平面への投影図形の中心点及び水平面上において中心点から一定の距離の点を包絡した近似図形を設定するとともに、侵入検知手段によりマニピュレータの動作状態を特定しマニピュレータの水平面への投影図形を設定しこれら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００２７】
近似図形としては、円、多角形等、どのような形状であってもよいが、侵入物体として想定される人の投影図形を、無駄なく包絡できる形状で、かつ、近似図形同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似図形は、複数の図形が組合わさったものであってもよい。
【００２８】
〔構成６〕
構成１、構成２、構成３、または、構成５を有するロボット装置の制御装置において、マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、警戒領域、近似立体、または、近似図形を拡大することを特徴とするものである。
【００２９】
また、本発明に係るロボット装置の制御方法は、以下の構成を有するものである。
【００３０】
〔構成７〕
構成１、構成２、構成３、または、構成５を有するロボット装置の制御装置において、侵入物体を包括する警戒領域を設定し、この警戒領域及びマニピュレータの可動領域を包括する警戒領域の少なくとも一方について、これら警戒領域よりも狭い一、または、二以上に多重化された危険領域を設定して多重化し、侵入物体領域とマニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、侵入物体領域とマニピュレータとの接近に応じて順次多段的に減速することを特徴とするものである。
【００３１】
〔構成８〕
マニピュレータを備えたロボット装置の動作を制御するためのロボット装置の制御方法であって、マニピュレータの可動領域を包括し該可動領域よりも広い領域であって侵入物体の侵入が可能である警戒領域に対する侵入物体の侵入を監視し、警戒領域内への侵入物体の侵入が検知された場合には、マニピュレータの動作を減速させ、マニピュレータの可動領域内への侵入物体の侵入が検知されるとともにマニピュレータと侵入物体との距離が所定の距離以下となったときには、マニピュレータの動作を停止させることを特徴とするものである。
【００３２】
〔構成９〕
構成８を有するロボット装置の制御方法において、侵入物体の監視結果に基づいて侵入物体を包絡する第１の近似立体を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００３３】
これら近似立体としては、球、円筒、立方体を含む正多面体等、どのような形状であってもよいが、侵入物体として想定される人と、マニピュレータとを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似立体は、複数の立体が組合わさったものであってもよい。
【００３４】
〔構成１０〕
構成８を有するロボット装置の制御方法において、侵入物体の監視結果に基づいて侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００３５】
これら近似図形としては、円、正方形を含む正多角形等、どのような形状であってもよいが、侵入物体として想定される人の投影図形と、マニピュレータの投影図形とを、無駄なく包絡できる形状で、かつ、近似図形同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似図形は、複数の図形が組合わさったものであってもよい。
【００３６】
〔構成１１〕
構成８を有するロボット装置の制御方法において、侵入物体の監視結果に基づいて侵入物体の中心点を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００３７】
〔構成１２〕
構成８を有するロボット装置の制御方法において、侵入物体の監視結果に基づいて侵入物体の水平面への投影図形の中心点及び水平面上において中心点から一定の距離の点を包絡した近似図形を設定するとともに、マニピュレータを監視することによりマニピュレータの動作状態を特定しマニピュレータの水平面への投影図形を設定し、これら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別することを特徴とするものである。
【００３８】
近似図形としては、円、多角形等、どのような形状であってもよいが、侵入物体として想定される人の投影図形を、無駄なく包絡できる形状で、かつ、近似図形同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似図形は、複数の図形が組合わさったものであってもよい。
【００３９】
〔構成１３〕
構成８、構成９、構成１０、または、構成１２を有するロボット装置の制御方法において、マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、警戒領域、近似立体、または、近似図形を拡大することを特徴とするものである。
【００４０】
〔構成１４〕
構成８、構成９、構成１０、または、構成１２を有するロボット装置の制御方法において、侵入物体を包括する警戒領域を設定し、この警戒領域及びマニピュレータの可動領域を包括する警戒領域の少なくとも一方について、これら警戒領域よりも狭い一、または、二以上に多重化された危険領域を設定して多重化し、侵入物体領域とマニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、侵入物体領域とマニピュレータとの接近に応じて順次多段的に減速することを特徴とするものである。
【発明の効果】
【００４１】
構成１を有する本発明に係るロボット装置の制御装置においては、制御手段は、検知手段により、警戒領域内への侵入物体の侵入が検知された場合には、マニピュレータの動作を減速させ、マニピュレータの可動領域内への侵入物体の侵入が検知されるとともにマニピュレータと侵入物体との距離が所定の距離以下となったときには、マニピュレータの動作を停止させる。
【００４２】
したがって、このロボット装置の制御装置においては、侵入物体がマニピュレータに接近して警戒領域内へ侵入しても、いきなりマニピュレータが停止することなく、まず、マニピュレータが減速される。このときに、侵入物体をマニピュレータから遠ざけることができれば、マニピュレータを停止させることがないので、ダウンタイムを最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。
【００４３】
そして、侵入物体がマニピュレータの可動領域内に侵入するとともに、マニピュレータと侵入物体との距離が所定の距離以下となったときに、マニピュレータの動作が停止されるので、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。また、このときには、マニピュレータが減速されているので、マニピュレータの動作状態を正確に特定することが容易となる。
【００４４】
構成２を有する本発明に係るロボット装置の制御装置においては、制御手段は、侵入検知手段による検知結果に基づいて侵入物体を包絡する第１の近似立体を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を確実に判別することができる。
【００４５】
構成３を有する本発明に係るロボット装置の制御装置においては、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００４６】
構成４を有する本発明に係るロボット装置の制御装置においては、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の中心点を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００４７】
構成５を有する本発明に係るロボット装置の制御装置においては、制御手段は、侵入検知手段による検知結果に基づいて侵入物体の水平面への投影図形の中心点及び水平面上において中心点から一定の距離の点を包絡した近似図形を設定するとともに、侵入検知手段によりマニピュレータの動作状態を特定しマニピュレータの水平面への投影図形を設定しこれら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００４８】
構成６を有する本発明に係るロボット装置の制御装置においては、マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、警戒領域、近似立体、または、近似図形を拡大するので、マニピュレータがワークを把持している場合においても、マニピュレータと侵入物体との接近を容易に判別することができ、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。
【００４９】
構成７を有する本発明に係るロボット装置の制御装置においては、侵入物体を包括する警戒領域を設定し、この警戒領域及びマニピュレータの可動領域を包括する警戒領域の少なくとも一方について、これら警戒領域よりも狭い危険領域を設定して多重化し、侵入物体領域とマニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、さらに減速して第２段階の減速を行うので、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避することができ、このとき、マニピュレータが減速されているので、マニピュレータの動作状態を正確に特定することが容易となる。
【００５０】
構成８を有する本発明に係るロボット装置の制御方法においては、マニピュレータの可動領域を包括し可動領域よりも広い領域であって侵入物体の侵入が可能である警戒領域に対する侵入物体の侵入を監視し、警戒領域内への侵入物体の侵入が検知された場合には、マニピュレータの動作を減速させ、マニピュレータの可動領域内への侵入物体の侵入が検知されるとともにマニピュレータと侵入物体との距離が所定の距離以下となったときには、マニピュレータの動作を停止させる。
【００５１】
したがって、このロボット装置の制御方法においては、侵入物体がマニピュレータに接近して警戒領域内へ侵入しても、いきなりマニピュレータが停止することなく、まず、マニピュレータが減速される。このときに、侵入物体をマニピュレータから遠ざけることができれば、マニピュレータを停止させることがないので、ダウンタイムを最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。
【００５２】
そして、侵入物体がマニピュレータの可動領域内に侵入するとともに、マニピュレータと侵入物体との距離が所定の距離以下となったときに、マニピュレータの動作が停止されるので、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。また、このときには、マニピュレータが減速されているので、マニピュレータの動作状態を正確に特定することが容易となる。
【００５３】
構成９を有する本発明に係るロボット装置の制御方法においては、侵入物体の監視結果に基づいて侵入物体を包絡する第１の近似立体を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を確実に判別することができる。
【００５４】
構成１０を有する本発明に係るロボット装置の制御方法においては、侵入物体の監視結果に基づいて侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００５５】
構成１１を有する本発明に係るロボット装置の制御方法においては、侵入物体の監視結果に基づいて侵入物体の中心点を設定するとともに、マニピュレータの構造及び該マニピュレータに対する制御情報に基づいてマニピュレータの動作状態を特定しこのマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００５６】
構成１２を有する本発明に係るロボット装置の制御方法においては、侵入物体の監視結果に基づいて侵入物体の水平面への投影図形の中心点及び水平面上において中心点から一定の距離の点を包絡した近似図形を設定するとともに、マニピュレータを監視することによりマニピュレータの動作状態を特定しマニピュレータの水平面への投影図形を設定し、これら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータと侵入物体との距離が所定の距離以下となったことを判別するので、マニピュレータと侵入物体との接近を容易に判別することができる。
【００５７】
構成１３を有する本発明に係るロボット装置の制御方法においては、マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、警戒領域、近似立体、または、近似図形を拡大するので、マニピュレータがワークを把持している場合においても、マニピュレータと侵入物体との接近を容易に判別することができ、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避し、安全を確保することができる。
【００５８】
すなわち、本発明は、マニピュレータと人との干渉、接触が確実に防止され、安全が確保されつつ、装置のダウンタイムが減少され、稼働効率が低下しないようになされたロボット装置の制御装置及びロボット装置の制御方法を提供することができるものである。
【００５９】
構成１４を有する本発明に係るロボット装置の制御方法においては、侵入物体を包括する警戒領域を設定し、この警戒領域及びマニピュレータの可動領域を包括する警戒領域の少なくとも一方について、これら警戒領域よりも狭い危険領域を設定して多重化し、侵入物体領域とマニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、さらに減速して第２段階の減速を行うので、マニピュレータの停止を必要最小限に抑えつつ、侵入物体とマニピュレータとの接触を回避することができ、このとき、マニピュレータが減速されているので、マニピュレータの動作状態を正確に特定することが容易となる。
【図面の簡単な説明】
【００６０】
【図１】本発明に係るロボット装置の制御装置の構成を示す模式的な側面図である。
【図２】本発明に係るロボット装置の制御装置において実施される本発明に係るロボット装置の制御方法の手順を示すフローチャートである。
【図３】マニピュレータがワークを把持した状態における本発明に係るロボット装置の制御装置の構成を示す模式的な側面図である。
【図４】本発明に係るロボット装置の制御装置の第２の実施の形態における構成を示す模式的な側面図である。
【図５】本発明に係るロボット装置の制御装置の第３の実施の形態における構成を示す模式的な側面図である。
【図６】侵入物体領域を多重化した第５の実施の形態を示す側面図である。
【図７】本発明に係るロボット装置の制御装置の第６の実施の形態における構成を示す模式的な側面図及び平面図である。
【図８】本発明に係るロボット装置の制御装置の第６の実施の形態における他の構成を示す模式的な平面図である。
【図９】本発明に係るロボット装置の制御装置の第７の実施の形態における構成を示す模式的な側面図及び平面図である。
【図１０】本発明に係るロボット装置の制御装置の第８の実施の形態における構成を示す模式的な側面図及び平面図である。
【発明を実施するための形態】
【００６１】
以下、本発明を実施するための形態について図面を参照して説明する。
【００６２】
〔ロボット装置の制御装置の構成（第１の実施の形態）〕
図１は、本発明に係るロボット装置の制御装置の構成を示す模式的な側面図である。
【００６３】
本発明に係るロボット装置の制御装置が制御するロボット装置は、加工、組立、ワークハンドリング、溶接、塗装等を行うものである。このロボット装置は、図１に示すように、ロボット基台部４と、このロボット基台部４上に設置されたマニピュレータ１とを有し、このマニピュレータ１により、作業対象（ワーク）の把持、運搬、加工及び他の部材への組立などの操作が可能となされている。また、このロボット装置においては、マニピュレータ１の可動領域内には、作業のために人が侵入することが前提とされている。
【００６４】
マニピュレータ１は、複数のアクチュエータ（駆動装置）とリンク（剛体の構造物）とによって構成されている。すなわち、各リンク間は、回動（屈曲）、または、旋回可能な関節２ａ，２ｂ，２ｃ，２ｄ，２ｅ，２ｆを介して接続されており、それぞれアクチュエータによって相対駆動されるようになっている。各アクチュエータは、制御手段を構成するロボット制御装置３によって制御される。
【００６５】
このマニピュレータ１において、第１のリンク（基端部のリンク）１ａは、ロボット基台部４に対し、第１の関節２ａを介して接続されて設置されている。第１の関節２ａは、鉛直軸（ｚ軸）回りに旋回可能な関節である。この第１のリンク１ａの先端側には、第２の関節２ｂを介して、第２のリンク１ｂの基端側が接続されている。第２の関節２ｂは、水平な軸回りに第２のリンク１ｂを回動可能とする関節である。第２のリンク１ｂの先端側には、第３の関節２ｃを介して、第３のリンク１ｃの基端側が接続されている。第３の関節２ｃは、水平な軸回りに第３のリンク１ｃを回動可能とする関節である。
【００６６】
そして、第３のリンク１ｃの先端側には、第４の関節２ｄを介して、第４のリンク１ｄの基端側が接続されている。第４の関節２ｄは、第３のリンク１ｃの軸回りに第４のリンク１ｄを回動可能とする関節である。第４のリンク１ｄの先端側には、第５の関節２ｅを介して、第５のリンク１ｅの基端側が接続されている。第５の関節２ｅは、水平な軸回りに第５のリンク１ｅを回動可能とする関節である。第５のリンク１ｅの先端側（手先）には、第６の関節２ｆを介して、作業対象を把持したり加工したりする先端ツール機構５が設けられている。この先端ツール機構５は、ロボット制御装置３によって制御される。
【００６７】
ロボット制御装置３は、マニピュレータ１の動作状態、すなわち、マニピュレータ１の各アクチュエータの移動速度及び移動方向を制御し、また、マニピュレータ１の減速、一時停止、非常停止等の動作モードを制御する。また、ロボット制御装置３は、マニピュレータ１に対する制御情報、すなわち、各関節２ａ，２ｂ，２ｃ，２ｄ，２ｅのアクチュエータに対する動作指令情報やツール機構５に対する動作指令情報に基づいて、各関節２ａ，２ｂ，２ｃ，２ｄ，２ｅの角度やツール機構５の把持情報などを取得し、マニピュレータ１やツール機構５の動作状態を特定することができる。なお、マニピュレータ１は垂直多関節型に限らず、円筒座標型，極座標型，直交座標型，水平多関節型などさまざなまな形態が考えられる。
【００６８】
また、ロボット装置を制御するロボット制御装置３の上位制御装置として、ロボット制御装置やツール機構に指令やシーケンスを与えるために統括制御装置としてＰＬＣなどが用いられることも多く、これらを介して、マニピュレータ１やツール機構５の動作状態を取得することも可能である。
【００６９】
そして、本発明に係るロボット装置の制御装置においては、マニピュレータ１の可動領域Ａを包括し可動領域Ａよりも広い領域であって侵入物体（例えば、作業者）１０１の侵入が可能である警戒領域Ｂが設定されている。
【００７０】
このロボット装置の制御装置は、警戒領域Ｂに対する侵入物体１０１の侵入を監視する侵入検知手段となる３次元センサ６を備えている。この３次元センサ６としては、例えば、レーザレーダやステレオカメラ等を使用することができる。この３次元センサ６は、マニピュレータ１の上方に設置することが好ましい。この３次元センサ６は、警戒領域Ｂよりも広い計測領域Ｃ内の物体までの距離を測定することができ、この測定結果に基づいて、警戒領域Ｂ内の物体を３次元計測することができる。
【００７１】
３次元センサ６による計測結果を示す計測データは、制御手段を構成する安全監視装置７に送られる。この安全監視装置は、３次元センサ６から送られた計測データと、ロボット制御装置３から送られるマニピュレータ１に対する制御情報（関節角情報や把持情報等）とに基づいて、侵入物体１０１とマニピュレータ１との間の距離を算出する。そして、安全監視装置は、侵入物体１０１とマニピュレータ１との間が所定の距離以下となっている場合には、ロボット制御装置３に対して、減速や非常停止を指示する動作指令を送る。ロボット制御装置３は、安全監視装置７から動作指令が送られると、この動作指令に従って、マニピュレータ１の動作を減速させたり、または、停止させる。
【００７２】
〔ロボット装置の制御方法（第１の実施の形態）〕
本発明に係るロボット装置の制御方法は、本発明に係るロボット装置の制御装置を動作させることによって実施される。このロボット装置の制御方法は、ロボット装置の通常の運転中だけではなく、調整、試験、メンテナンス、教示、検査等を含む種々の作業中にも実施することができる。
【００７３】
ロボット装置の制御装置において、安全監視装置７及びロボット制御装置３は、３次元センサ６により、警戒領域Ｂ内への侵入物体１０１の侵入が検知された場合には、マニピュレータ１の動作を減速させ、マニピュレータ１の可動領域Ａ内への侵入物体１０１の侵入が検知されるとともに、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったときには、マニピュレータ１の動作を停止させる。
【００７４】
図２は、本発明に係るロボット装置の制御装置において実施される本発明に係るロボット装置の制御方法の手順を示すフローチャートである。
【００７５】
すなわち、このロボット装置の制御装置において、安全監視装置７及びロボット制御装置３は、図２に示すように、所定の処理を、サイクル毎、もしくは、逐次処理にて実行する。なお、この処理の開始時には、警戒領域Ｂ及び可動領域Ａ内には、図１に示すように、周辺機器等の固定物体１０２の他には、侵入物体１０１が侵入していないものとする。
【００７６】
図２のステップｓｔ１において、処理をスタートすると、ステップｓｔ２に進み、３次元センサ６からの計測データから、計測領域Ｃ内における固定物体１０２及びマニピュレータ１のデータを削除する。ここで、３次元センサ６とマニピュレータ１との位置関係が予めキャリブレーションされているものとし、安全監視装置７は、３次元センサ６からの計測データと同期したタイミング（同時刻）で、ロボット制御装置３から、マニピュレータ１の関節角情報などの制御情報を取得する。なお、これら計測データと制御情報とは、実際に同時刻に取得されなくとも、それぞれにタイムスタンプ情報が付加されていれば、このタイムスタンプ情報により、同期したデータとして処理することができる。また、それぞれが同期しないタイミングでデータを取得する場合には、最大となる同期ズレ時間分で考えられる互いの移動量を考慮して、後に設定する安全距離などに反映することが考えられる。
【００７７】
次に、ステップｓｔ３に進み、計測領域Ｃ内における侵入物体１０１の有無を判別する。侵入物体１０１が検出された場合には、ステップｓｔ４に進み、侵入物体１０１が検出されない場合には、ステップｓｔ２に戻る。
【００７８】
ここで、マニピュレータ１は動作するため、マニピュレータ１と侵入物体１０１とは、計測データにおいては同様の動体となってしまうため、これらを判別する必要がある。そこで、マニピュレータ１の構造は予め分かっているので、関節などの配置を考慮して、マニピュレータ１を複数の球などの第２の近似立体で包絡した領域（以下、「マニピュレータ領域」という。）を設定する。この領域の情報に関節角度などの制御情報を与えることにより、計測データ取得時におけるマニピュレータ領域を求めることができる。計測データとマニピュレータ１の制御情報とは同期したデータとして処理できるため、計測データとマニピュレータ領域とを付き合わせて処理をすることにより、計測データから、マニピュレータ１の動作を分離し削除することができる。
【００７９】
同様に、事前に取得、または、設定された計測領域Ｃ内に存在する固定物体１０２の包絡領域データを利用し、もしくは、前回の計測から変化がない部分を固定物体１０２とみなして、これを計測データから削除することにより、計測データから、固定物体１０２を分離し削除することができる。
【００８０】
このようにして、計測領域Ｃ内に存在する侵入物体１０１を抽出することができる。このとき、例えば、ロボット制御装置３から得られたデータに異常があり、現実のマニピュレータ１の動作と合致しない場合には、データの付き合せにより、マニピュレータ１の動作を分離することができないので、マニピュレータ１の近傍の領域内に、侵入物物体１０１が突然現れたように判別されることになる。このような場合には、ロボット制御装置３からのデータが異常であると判別して、マニピュレータ１を非常停止させるようにしてもよい。
【００８１】
ステップｓｔ４では、侵入物体１０１が警戒領域Ｂ内に侵入しているかを判別し、警戒領域Ｂ内に侵入していればステップｓｔ５に進み、警戒領域Ｂ内に侵入していなければステップｓｔ２に戻る。
【００８２】
計測領域Ｃ内には、前述したように、警戒領域Ｂが設定されている。警戒領域Ｂは、マニピュレータ１の可動領域Ａを包括し可動領域Ａよりも広い領域であり、侵入物体１０１の侵入が可能な領域である。なお、可動領域Ａ内であっても、侵入物体１０１の侵入があり得ない領域は、警戒領域Ｂに含める必要はなく、計測領域Ｃに含める必要もない。図１においては、警戒領域Ｂは、３次元センサ６から放射状に設定されており、可動領域Ａより大きく包絡される床付近の部分をカットしている。
【００８３】
ステップｓｔ５では、安全監視装置７は、抽出された侵入物体１０１のデータから、侵入物体１０１を含む領域（以下、「侵入物体領域」という。）を設定する。すなわち、侵入物体１０１から安全距離を隔てた位置までの領域を、球、円筒、立方体を含む正多面体等の第１の近似立体で包絡して、侵入物体領域を設定する。または、侵入物体１０１を人と想定し、侵入物体１０１の中央と考えられる位置から、人が手足を伸ばした場合に届く範囲に安全距離分を加えた領域を近似立体で包絡して、侵入物体領域を設定する。なお、具体的な侵入物体領域の設定としては、侵入物体１０１のデータのうち、最上点（頂点）から床面まで垂線を降ろし、この垂線の中点を侵入物体１０１の中心とし、この中心から人が飛び出さないであろう半径を設定した球を設定することなどが考えられる。
【００８４】
これら近似立体としては、球、円筒、多面体等、どのような形状であってもよいが、侵入物体として想定される人と、マニピュレータとを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。なお、近似立体は、複数の立体が組合わさったものであってもよい。
【００８５】
次のステップｓｔ６では、前述したように、マニピュレータ領域を設定し、ステップｓｔ７に進む。
【００８６】
ステップｓｔ７では、マニピュレータ領域と侵入物体領域との干渉の有無を判別する。各領域の干渉がある場合には、ステップｓｔ９に進み、各領域の干渉がない場合には、ステップｓｔ８に進む。
【００８７】
ステップｓｔ８では、安全監視装置７は、マニピュレータ１の動作速度を安全な速度に落とすような減速指令をロボット制御装置３に送り、マニピュレータ１を減速させ、ステップｓｔ２に戻る。このとき、マニピュレータ１は停止せず、マニピュレータ１による作業も停止しない。安全な速度とは、例えば、ＩＳＯ１０２１８−１に規定されているように、産業用ロボットと人とが共存可能な速度の上限である２５０ｍｍ／sec以内の速度で、事前のリスクアセスメントなどによって決定される。
【００８８】
そして、ステップｓｔ９では、安全監視装置７は、ロボット制御装置３に対して、非常停止指令を送り、マニピュレータ１を非常停止させ、ステップｓｔ１０に進んで処理を終了する。
【００８９】
このようなロボット装置の制御方法において、最大サイクル時間、マニピュレータの移動最大速度や、警戒領域Ｂ、マニピュレータ領域及び侵入物体領域等の各領域間の余裕等は、侵入物体１０１とマニピュレータ１との接触状況を十分に想定、勘案して、決定される。例えば、マニピュレータ１の移動速度を早く設定したい場合には、サイクル時間を短くし、各領域間の余裕を大きくとることが望ましい。また、非常停止指令が発信されてから、実際にマニピュレータ１が停止するまでの移動距離（安全距離）等も考慮するとよい。
【００９０】
図３は、マニピュレータがワークを把持した状態における本発明に係るロボット装置の制御装置の構成を示す模式的な側面図である。
【００９１】
図３に示すように、マニピュレータ１がワーク１０３を把持した場合には、ワーク１０３が大きいと、ワーク１０３を把持したマニピュレータ１の可動領域Ａ´は、把持していないマニピュレータ１のみの可動領域Ａに比べて、大きくなる。この場合、安全監視装置７は、ロボット制御装置３から、マニピュレータ１がワーク１０３を把持しているか否かの情報を取得し、この情報により、警戒領域Ｂを拡大して新たな警戒領域Ｂ´とし、マニピュレータ領域も拡大することにより、マニピュレータ１及びワーク１０３と侵入物体１０１との接触を防止し、ダウンタイムを低減させることができる。
【００９２】
このように、本発明に係るロボット装置の制御装置及びロボット装置の制御方法においては、マニピュレータ１の可動領域Ａの内部への侵入物体１０１の侵入を常時監視しているので、従来のような入退扉の開閉により制御するロボット装置に比較して、フールプルーフな対策となっており、さらに、マニピュレータ１と侵入物体１０１との位置関係から、これらの接触、干渉の虞があるときには、マニピュレータ１を安全速度に減速し、さらに、必要な場合のみに非常停止させる。
【００９３】
本発明においては、侵入物体１０１のマニピュレータ１に対する接近により、いきなり非常停止するのではなく、まず、マニピュレータ１の減速がなされ、このときには、作業そのものは続行される。そのため、作業者（侵入物体１０１）がマニピュレータ１との接触を避けるための時間が確保できるとともに、接触を避ければ非常停止を回避することができるので、装置のダウンタイムを削減することができる。
【００９４】
すなわち、本発明においては、ロボット制御装置３からマニピュレータ１に対する制御情報を取得し、または、３次元センサ６による計測結果から、マニピュレータ１の位置、挙動と侵入物体１０１の位置、挙動を分離して判別し、これらの接触可能性を監視するため、例えば、マニピュレータ１と作業者との間に十分な安全距離があるような場合に、うっかり可動領域Ａに踏み込むケースや、ワークの位置ずれなどを直す等の短時間の作業のかめに可動領域Ａに侵入するなどしても、非常停止にならず、マニピュレータ１は稼動を続けるので、ダウンタイムの発生を極力少なくすることができる。また、このような状況で、作業者の思い違いや、作業時間の見込み違い、作業者のロボット装置に対する理解不足などにより、マニピュレータ１との接触の危険性が発生しても、マニピュレータ１は、作業者と接触する前に非常停止する。
【００９５】
このように、本発明においては、マニピュレータ１の可動領域Ａに侵入物体１０１が侵入したという理由だけでは非常停止しないので、非常停止によるダウンタイムなど、稼働効率の低下要因を極力排除し、ロボット装置を高効率に運用することができる。
【００９６】
また、マニピュレータ１が減速されたときには、マニピュレータ１の動作と侵入物体１０１の分離処理などの情報処理が容易となり、その後に行われるマニピュレータ１の可動領域Ａ内における侵入物体１０１の認識処理も容易となる。例えば、３次元センサ６としてレーザレンジファインダなどを利用した場合には、走査して計測をおこなうため、計測対象が高速で動く場合には、移動を伴うデータとして記録される。そのため、計測対象が高速移動すると、侵入物体１０１の位置を正確に同定し、マニピュレータ１と侵入物体１０１とを精密に分離する処理が困難になる。マニピュレータ１が減速されることにより、侵入物体１０１の位置を正確に同定できるようになり、マニピュレータ１と侵入物体１０１とを精密に分離する処理が可能となる。
【００９７】
さらに、本発明においては、マニピュレータ１が物品を弾き飛ばしたりするような作業を行う場合でなければ、マニピュレータ１の周囲に安全柵を設置しなくとも、十分に安全性を確保することができる。安全柵を設置せずに済めば、敷地の有効活用ができ、ロボット装置を使用するうえでの制約条件が低減され、コスト低減も期待できる。
【００９８】
〔第２の実施の形態〕
図４は、本発明に係るロボット装置の制御装置の第２の実施の形態における構成を示す模式的な側面図である。
【００９９】
前述の実施の形態においては、侵入検知手段として、１台の３次元センサ６を使用しているが、図４中の（ａ）に示すように、周辺装置などの固定物体１０２の位置によっては、３次元センサ６に死角が生ずる場合もある。このような死角をなくし、また、計測領域Ｃをより広範囲とするため、図４中の（ｂ）に示すように、複数の３次元センサ６を統合して使用するようにしてもよい。
【０１００】
すなわち、このロボット装置の制御装置においては、侵入検知手段として、２台の３次元センサ６ａ，６ｂを使用している。この制御装置においては、第１及び第２の３次元センサ６ａ，６ｂのそれぞれについて、計測領域Ｃ１，Ｃ２が設定されており、これら各計測領域Ｃ１，Ｃ２のいずれかに侵入した侵入物体１０１が計測される。また、各計測領域Ｃ１，Ｃ２について、それぞれ警戒領域Ｂ１，Ｂ２が設定される。これら各警戒領域Ｂ１，Ｂ２のいずれかに属する領域が、警戒領域Ｂとなる。
【０１０１】
このロボット装置の制御装置においては、３次元センサ６が１台の場合には固定物体１０２の死角に入ってしまっていた侵入物体１０１ｂが、一方の３次元センサ６ｂによっては計測されており、警戒領域Ｂに接近していることが検知される。
【０１０２】
〔第３の実施の形態〕
図５は、本発明に係るロボット装置の制御装置の第３の実施の形態における構成を示す模式的な側面図である。
【０１０３】
前述の実施の形態においては、マニピュレータ１を１台有するロボット装置を制御対象としているが、図５に示すように、複数のマニピュレータ１，１を有するロボット装置、または、複数のロボット装置を制御対象としてもよい。
【０１０４】
すなわち、ロボット装置は、同一のセル（同一領域）において、複数台が同時に稼働する場合がある。このような場合には、安全監視装置７が複数台のロボット制御装置３，３、もしくは、これらを統括管理する制御装置からデータを取得して、前述の実施の形態と同様にして、複数のマニピュレータ１，１に対する減速指令や非常停止指令を発するようにしてもよい。
【０１０５】
また、可動領域Ａ内に存在する周辺装置などに、人に危害を与え得るような可動部が設けられている場合には、これを第２、第３のロボットと考えて、ロボット装置と同様の制御を行うことができる。この場合には、安全監視装置７は、その周辺装置の制御装置、または、複数の制御装置を統括管理する制御装置からデータを取得して、前述の実施の形態と同様にして、マニピュレータ１及び周辺装置に対する減速指令や非常停止指令を発する。
【０１０６】
さらに、ロボット装置が同一のセル内に存在しない他の機器と連動して動作する場合には、安全監視装置７は、それら他の機器に対しても、減速指令や非常停止指令を発するようにするとよい。この場合には、ロボット装置と他の機器との連動した作業を円滑に継続させることができる。
【０１０７】
同様に、溶接や塗装などの自動作業を行う工程では、ロボットの動作のみが減速され一時停止されると、溶接や塗装などの品質に対して致命的なダメージを与えることが考えられるため、溶接装置の制御装置や塗装ガンの制御装置などに対しても、速度調整、一時停止指令を行うように構成することが好ましい。この場合には、安全監視装置７は、溶接装置の制御装置や塗装ガンの制御装置、または、これら制御装置を統括管理する制御装置からデータを取得して、前述の実施の形態と同様にして、マニピュレータ１及び溶接装置、または、塗装ガンに対する減速指令や非常停止指令を発する。
【０１０８】
なお、実際の運用を考えると、本発明において使用される３次元センサ６や安全監視装置７には、必要な安全対策、例えば、２重化や自己診断などの措置が取られていることが必要である。また、マニピュレータ１についても、減速や非常停止に関する部分については、同様の対策がなされていることが望ましい。例えば、ロボット装置の内部位置センサ周辺部や、減速及び非常停止指令の受付部などである。また、安全監視装置７及び３次元センサ６は、電源が切れている場合等、正常に起動していない状態においては、フェールセーフのため、ロボット制御装置３に対して、非常停止指令を出し続けている状態とする必要がある。
【０１０９】
〔第４の実施の形態〕
前述の実施の形態においては、侵入検知手段となる３次元センサ６して、レーザレーダ（レーザレンジファインダ）を例示しているが、３次元センサ６としては、ステレオカメラ等を用いることもできる。
【０１１０】
また、警戒領域Ｂを精密に設定するには、３次元センサは有効であるが、侵入物体領域とマニピュレータ領域との干渉を監視することについては、他のセンサの使用も考えられる。例えば、２次元センサの組み合わせにより３次元情報を取得する構成や、２次元センサと既知の情報との組み合わせにより、３次元情報として扱う手法などが考えられる。侵入物体１０１を作業者であると想定した場合には、通常のカメラを用いて作業者の頭部を画像処理により認識し、この情報に既知の人体のサイズを組み合わせることにより、侵入物体１０１（作業者）の中心位置を特定することができる。
【０１１１】
さらに、侵入検知手段となるセンサとしては、赤外線飛行時間計測方式の３次元距離測定装置や、マイクロ波センサ、超音波センサなどを使用することができる。また、複数台のカメラを作業環境の周囲に配置することによる立体映像取得方法（視体積交差法）も使用することができる。さらに、これら種々のセンサ及び手法を組み合わせて使用することもできる。
【０１１２】
〔第５の実施の形態〕
図６は、侵入物体領域を多重化した第５の実施の形態を示す側面図である。
【０１１３】
また、本発明においては、図６に示すように、侵入物体１０１を包括する侵入物体領域を、警戒領域と一、または、二以上に多重化された危険領域とに多重化してもよい。同様に、マニピュレータ領域についても、多重化してもよい。この場合には、侵入物体１０１とマニピュレータ１との接近状況を多段的に認識することができ、これらの接近に応じて、マニピュレータ１の速度を順次多段的にに減速させることができる。すなわち、侵入物体領域とマニピュレータ領域との警戒領域同士が重なった場合には、第１段階の減速を行い、一方の領域の危険領域と他方の領域の警戒領域とが重なった場合には、さらに減速して第２段階の減速を行い、各領域の危険領域同士が重なった場合以降は、第３段階以降の原則を順次行い、最後は非常停止を行うなどの制御が可能となる。この場合には、適宜の設定を行うことにより、ダウンタイムの発生を最小限とすることができる。
【０１１４】
〔第６の実施の形態〕
図７は、本発明に係るロボット装置の制御装置の第６の実施の形態における構成を示す模式的な側面図及び平面図である。
【０１１５】
本発明に係るロボット装置の制御装置においては、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったときに、マニピュレータ１と侵入物体１０１との位置関係の判定は、図７中の（ｂ）に示すように、マニピュレータ１及び侵入物体１０１の水平面への投影図形を包絡する近似図形を設定することによって行ってもよい。
【０１１６】
この場合、安全監視装置７は、侵入検知手段による検知結果に基づいて、侵入物体１０１の水平面への投影図形を包絡する第１の近似図形を設定するとともに、マニピュレータ１の構造及びマニピュレータ１に対する制御情報に基づいて、マニピュレータ１の動作状態を特定し、このマニピュレータ１の水平面への投影図形を包絡する第２の近似図形を設定する。そして、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったことを判別する。ここで、侵入検知手段は、図７中の（ａ）に示すように、３次元センサであってもよいし、２次元センサであってもよい。
【０１１７】
すなわち、安全監視装置７は、まず、侵入物体１０１と判断される領域を水平面（床面）に投影した形状を特定し、この形状の中央の点（図心等）を代表点をし、この代表点を中心として、侵入物体１０１と判断される領域の投影図形を包絡する領域として、例えば、人のリーチが届く範囲に安全距離分などを加えた領域を第１の近似図形を設定し、侵入物体領域とする。この第１の近似図形は、例えば、円や長方形等とするとよい。
【０１１８】
次に、安全監視装置７は、マニピュレータ１の構造及び関節などの配置に基づいて予め設定された代表点と、ロボット制御装置３より取得した制御情報とから、空間に位置付けられる各代表点を水平面（床面）に投影した点を中心として、マニピュレータ１と判断される領域の投影図形を包絡する領域として、第２の近似図形を設定し、マニピュレータ領域とする。この第２の近似図形は、例えば、複数の円からなるものとするとよい。
【０１１９】
そして、安全監視装置７は、データ取得時において、これらマニピュレータ領域及び侵入物体領域の干渉の有無を判別し、干渉があった場合には、ロボット制御装置３に対して、非常停止指令を発信し、マニピュレータ１を非常停止させる。
【０１２０】
なお、近似図形としては、円、正方形を含む多角形等、どのような形状であってもよいが、侵入物体１０１として想定される人の投影図形と、マニピュレータ１の投影図形とを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することが好ましい。マニピュレータ１の投影図形を包絡する第２の近似図形は、複数の図形が組合わさったものであってもよい。近似図形を円とすると、中心から等距離の点の集合であるという円の性質から、干渉の有無の判別を容易に行うことができる。
【０１２１】
図８は、本発明に係るロボット装置の制御装置の第６の実施の形態における他の構成を示す模式的な平面図である。
【０１２２】
このロボット装置の制御装置おいて、侵入検知手段を２次元センサとする場合には、図８中の（ａ）及び（ｂ）に示すように、２次元センサ６ｃは、マニピュレータ１の上方に設置する必要はなく、ロボット基台部４の周囲部に設置し、このロボット基台部４の周囲における物体の有無を検出するセンサとしてもよい。これら２次元センサ６ｃにより、図８中の（ｃ）に示すように、侵入物体１０１の下部、すなわち、侵入物体１０１が人であれば、足首部分が検知される。このようにして侵入物体１０１の下部が検知された場合には、安全監視装置７は、これを人であると想定して、検知された位置を中心として、予め設定した高さ（例えば、人の平均身長）の侵入物体１０１が存在するものと判別する。侵入物体１０１の存在が判別されれば、この侵入物体１０１に基づいて、近似立体や近似図形を設定することにより、前述の実施の形態と同様にして、この侵入物体１０１とマニピュレータ１との接近、干渉を判別することができる。
【０１２３】
〔第７の実施の形態〕
図９は、本発明に係るロボット装置の制御装置の第７の実施の形態における構成を示す模式的な側面図及び平面図である。
【０１２４】
本発明に係るロボット装置の制御装置においては、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったとき、マニピュレータ１と侵入物体１０１との位置関係の判定は、図９中の（ａ）及び（ｂ）に示すように、３次元センサ６による検知結果に基づいて侵入物体１０１の中心点を設定し、マニピュレータ１の構造及びマニピュレータ１に対する制御情報に基づいてマニピュレータ１の動作状態を特定し、このマニピュレータ１の複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより行ってもよい。
【０１２５】
すなわち、安全監視装置７は、まず、侵入物体１０１と判断される領域の中心点を設定する。中心点の設定は、侵入物体１０１を人と想定した場合には、侵入物体１０１の最頂点、すなわち、人の頭部中央から床面に垂線を降ろし、この垂線の中点を中心点と設定することができる。
【０１２６】
次に、安全監視装置７は、マニピュレータ１の構造及び関節などの配置に基づいて予め設定された代表点と、ロボット制御装置３より取得した制御情報とから、空間に位置付けられる各代表点を設定する。
【０１２７】
そして、安全監視装置７は、データ取得時において、これら侵入物体１０１の中心点及びマニピュレータ１の各代表点の間の距離を判別し、この距離が所定の距離、例えば、安全距離以下となった場合には、ロボット制御装置３に対して、非常停止指令を発信し、マニピュレータ１を非常停止させる。ここで、安全距離は、マニピュレータ１の移動速度をパラメータとする変数として設定してもよい。例えば、マニピュレータ１の移動速度が速い場合には、安全距離を長くし、マニピュレータ１の移動速度が遅い場合には、安全距離を短くするように設定することにより、装置のダウンタイムの発生及び作業効率の低下を防止することができる。
【０１２８】
なお、侵入物体１０１の中心点及びマニピュレータ１の各代表点の間の距離の判別は、これら中心点及び各代表点を水平面（床面）に投影した投影点を設定し、これら各投影点の水平面上における距離を判別するようにしてもよい。
【０１２９】
また、侵入物体１０１の中心点及びマニピュレータ１の各代表点の間の距離の判別においては、マニピュレータ１の各代表点について、先端側ほど高い重み付けを設定し、先端部の影響を高めたうえで、判別するようにしてもよい。これは、マニピュレータ１は、形態にもよるが、一般的に先端ほど高速、かつ、予想し得ない多方向に動き、人との接触は、マニピュレータ１の先端部分において発生しやすいからである。
【０１３０】
〔第８の実施の形態〕
図１０は、本発明に係るロボット装置の制御装置の第８の実施の形態における構成を示す模式的な側面図及び平面図である。
【０１３１】
本発明に係るロボット装置の制御装置においては、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったときに、マニピュレータ１と侵入物体１０１との位置関係を判定する方法としては、図１０中の（ｂ）に示すように、侵入物体１０１の水平面への投影図形を包絡する近似図形と、マニピュレータ１の水平面への投影図形を設定することによって行ってもよい。
【０１３２】
この場合、安全監視装置７は、侵入検知手段による検知結果に基づいて、侵入物体１０１の水平面への投影図形を包絡する第１の近似図形を設定する。また、安全監視装置７は、侵入検知手段による検知結果に基づいて、マニピュレータ１の水平面への投影図形を設定する。そして、これら近似図形及び投影図形の干渉の有無を判定することにより、マニピュレータ１と侵入物体１０１との距離が所定の距離以下となったことを判別する。ここで、侵入検知手段は、図１０中の（ａ）に示すように、３次元センサであってもよいし、２次元センサであってもよい。
【０１３３】
すなわち、安全監視装置７は、まず、侵入物体１０１と判断される領域を水平面（床面）に投影した形状を特定し、この形状の中央の点（図心等）を代表点とし、この代表点を中心として、侵入物体１０１と判断される領域の投影図形を包絡する領域として、例えば、人のリーチが届く範囲に安全距離分などを加えた領域を近似図形を設定し、侵入物体領域とする。
【０１３４】
この近似図形としては、円、正方形を含む多角形等、どのような形状であってもよいが、侵入物体１０１として想定される人の投影図形と、マニピュレータ１の投影図形とを、無駄なく包絡できる形状で、かつ、近似立体同士が干渉したときに、実際の物体同士の間に、例えば、ＩＳＯ１３８５５に規定されているような十分な安全距離が確保されるような大きさを有することがが好ましい。マニピュレータ１の投影図形を包絡する第２の近似図形は、複数の図形組合わさったものであってもよい。近似図形を円とすると、中心から等距離の点の集合であるという円の性質から、干渉の有無の判別を容易に行うことができる。
【０１３５】
次に、安全監視装置７は、侵入検知手段によりマニピュレータ１と判断される領域を水平面（床面）に投影した投影図形を設定する。
【０１３６】
そして、安全監視装置７は、データ取得時において、これら侵入物体領域及びマニピュレータ１の投影図形の干渉の有無を判別し、干渉があった場合には、ロボット制御装置３に対して、非常停止指令を発信し、マニピュレータ１を非常停止させる。
【０１３７】
この場合には、安全監視装置７は、ロボット制御装置３から、マニピュレータ１に対する制御情報を取得する必要はない。
【産業上の利用可能性】
【０１３８】
本発明は、ロボット装置の制御装置及びロボット装置の制御方法に適用され、ロボット装置のマニピュレータの可動領域に人などが侵入した場合の保安、安全の向上を図ることができる。
【符号の説明】
【０１３９】
１ マニピュレータ
３ ロボット制御装置
４ ロボット基台部
５ 先端ツール機構
６ ３次元センサ
７ 安全監視装置
１０１ 侵入物体
【特許請求の範囲】
【請求項１】
マニピュレータを備えたロボット装置の動作を制御するためのロボット装置の制御装置であって、
前記マニピュレータの可動領域を包括し該可動領域よりも広い領域であって、侵入物体の侵入が可能である警戒領域に対する前記侵入物体の侵入を監視する侵入検知手段と、
前記マニピュレータの動作状態を特定するとともに、該マニピュレータの動作を制御する制御手段と
を備え、
前記制御手段は、前記検知手段により、前記警戒領域内への前記侵入物体の侵入が検知された場合には、前記マニピュレータの動作を減速させ、前記マニピュレータの可動領域内への前記侵入物体の侵入が検知されるとともに、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったときには、前記マニピュレータの動作を停止させる
ことを特徴とするロボット装置の制御装置。
【請求項２】
前記侵入検知手段は、３次元認識センサであって、
前記制御手段は、前記侵入検知手段による検知結果に基づいて前記侵入物体を包絡する第１の近似立体を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項１記載のロボット装置の制御装置。
【請求項３】
前記侵入検知手段は、２次元認識センサ、または、３次元認識センサであって、
前記制御手段は、前記侵入検知手段による検知結果に基づいて前記侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項１記載のロボット装置の制御装置。
【請求項４】
前記侵入検知手段は、３次元認識センサであって、
前記制御手段は、前記侵入検知手段による検知結果に基づいて前記侵入物体の中心点を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項１記載のロボット装置の制御装置。
【請求項５】
前記侵入検知手段は、２次元認識センサ、または、３次元認識センサであって、
前記制御手段は、前記侵入検知手段による検知結果に基づいて前記侵入物体の水平面への投影図形の中心点及び水平面上において前記中心点から一定の距離の点を包絡した近似図形を設定するとともに、前記侵入検知手段により前記マニピュレータの動作状態を特定し前記マニピュレータの水平面への投影図形を設定し、これら近似図形及び投影図形の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項１記載のロボット装置の制御装置。
【請求項６】
前記マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、前記警戒領域、前記近似立体、または、前記近似図形を拡大する
ことを特徴とする請求項１、請求項２、請求項３、または、請求項５記載のロボット装置の制御装置。
【請求項７】
前記侵入物体を包括する警戒領域を設定し、この警戒領域及び前記マニピュレータの可動領域を包括する前記警戒領域の少なくとも一方について、これら警戒領域よりも狭い一、または、二以上に多重化された危険領域を設定して多重化し、
前記侵入物体領域と前記マニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、前記侵入物体領域と前記マニピュレータとの接近に応じて順次多段的に減速する
ことを特徴とする請求項１、請求項２、請求項３、または、請求項５記載のロボット装置の制御装置。
【請求項８】
マニピュレータを備えたロボット装置の動作を制御するためのロボット装置の制御方法であって、
前記マニピュレータの可動領域を包括し該可動領域よりも広い領域であって、侵入物体の侵入が可能である警戒領域に対する前記侵入物体の侵入を監視し、
前記警戒領域内への前記侵入物体の侵入が検知された場合には、前記マニピュレータの動作を減速させ、前記マニピュレータの可動領域内への前記侵入物体の侵入が検知されるとともに、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったときには、前記マニピュレータの動作を停止させる
ことを特徴とするロボット装置の制御方法。
【請求項９】
前記侵入物体の監視結果に基づいて、前記侵入物体を包絡する第１の近似立体を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項８記載のロボット装置の制御方法。
【請求項１０】
前記侵入物体の監視結果に基づいて、前記侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項８記載のロボット装置の制御方法。
【請求項１１】
前記侵入物体の監視結果に基づいて、前記侵入物体の中心点を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項８記載のロボット装置の制御方法。
【請求項１２】
前記侵入物体の監視結果に基づいて、前記侵入物体の水平面への投影図形の中心点及び水平面上において前記中心点から一定の距離の点を包絡した近似図形を設定するとともに、前記マニピュレータを監視することにより前記マニピュレータの動作状態を特定し前記マニピュレータの水平面への投影図形を設定し、これら近似図形及び投影図形の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項８記載のロボット装置の制御方法。
【請求項１３】
前記マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、前記警戒領域、前記近似立体、または、前記近似図形を拡大する
ことを特徴とする請求項８、請求項９、請求項１０、または、請求項１２記載のロボット装置の制御方法。
【請求項１４】
前記侵入物体を包括する警戒領域を設定し、この警戒領域及び前記マニピュレータの可動領域を包括する前記警戒領域の少なくとも一方について、これら警戒領域よりも狭い一、または、二以上に多重化された危険領域を設定して多重化し、
前記侵入物体領域と前記マニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、前記侵入物体領域と前記マニピュレータとの接近に応じて順次多段的に減速する
ことを特徴とする請求項８、請求項９、請求項１０、または、請求項１２記載のロボット装置の制御方法。
【請求項１】
マニピュレータを備えたロボット装置の動作を制御するためのロボット装置の制御装置であって、
前記マニピュレータの可動領域を包括し該可動領域よりも広い領域であって、侵入物体の侵入が可能である警戒領域に対する前記侵入物体の侵入を監視する侵入検知手段と、
前記マニピュレータの動作状態を特定するとともに、該マニピュレータの動作を制御する制御手段と
を備え、
前記制御手段は、前記検知手段により、前記警戒領域内への前記侵入物体の侵入が検知された場合には、前記マニピュレータの動作を減速させ、前記マニピュレータの可動領域内への前記侵入物体の侵入が検知されるとともに、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったときには、前記マニピュレータの動作を停止させる
ことを特徴とするロボット装置の制御装置。
【請求項２】
前記侵入検知手段は、３次元認識センサであって、
前記制御手段は、前記侵入検知手段による検知結果に基づいて前記侵入物体を包絡する第１の近似立体を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項１記載のロボット装置の制御装置。
【請求項３】
前記侵入検知手段は、２次元認識センサ、または、３次元認識センサであって、
前記制御手段は、前記侵入検知手段による検知結果に基づいて前記侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項１記載のロボット装置の制御装置。
【請求項４】
前記侵入検知手段は、３次元認識センサであって、
前記制御手段は、前記侵入検知手段による検知結果に基づいて前記侵入物体の中心点を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項１記載のロボット装置の制御装置。
【請求項５】
前記侵入検知手段は、２次元認識センサ、または、３次元認識センサであって、
前記制御手段は、前記侵入検知手段による検知結果に基づいて前記侵入物体の水平面への投影図形の中心点及び水平面上において前記中心点から一定の距離の点を包絡した近似図形を設定するとともに、前記侵入検知手段により前記マニピュレータの動作状態を特定し前記マニピュレータの水平面への投影図形を設定し、これら近似図形及び投影図形の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項１記載のロボット装置の制御装置。
【請求項６】
前記マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、前記警戒領域、前記近似立体、または、前記近似図形を拡大する
ことを特徴とする請求項１、請求項２、請求項３、または、請求項５記載のロボット装置の制御装置。
【請求項７】
前記侵入物体を包括する警戒領域を設定し、この警戒領域及び前記マニピュレータの可動領域を包括する前記警戒領域の少なくとも一方について、これら警戒領域よりも狭い一、または、二以上に多重化された危険領域を設定して多重化し、
前記侵入物体領域と前記マニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、前記侵入物体領域と前記マニピュレータとの接近に応じて順次多段的に減速する
ことを特徴とする請求項１、請求項２、請求項３、または、請求項５記載のロボット装置の制御装置。
【請求項８】
マニピュレータを備えたロボット装置の動作を制御するためのロボット装置の制御方法であって、
前記マニピュレータの可動領域を包括し該可動領域よりも広い領域であって、侵入物体の侵入が可能である警戒領域に対する前記侵入物体の侵入を監視し、
前記警戒領域内への前記侵入物体の侵入が検知された場合には、前記マニピュレータの動作を減速させ、前記マニピュレータの可動領域内への前記侵入物体の侵入が検知されるとともに、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったときには、前記マニピュレータの動作を停止させる
ことを特徴とするロボット装置の制御方法。
【請求項９】
前記侵入物体の監視結果に基づいて、前記侵入物体を包絡する第１の近似立体を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータを包絡する第２の近似立体を設定し、これら第１及び第２の近似立体同士の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項８記載のロボット装置の制御方法。
【請求項１０】
前記侵入物体の監視結果に基づいて、前記侵入物体の水平面への投影図形を包絡する第１の近似図形を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータの水平面への投影図形を包絡する第２の近似図形を設定し、これら第１及び第２の近似図形同士の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項８記載のロボット装置の制御方法。
【請求項１１】
前記侵入物体の監視結果に基づいて、前記侵入物体の中心点を設定するとともに、前記マニピュレータの構造及び該マニピュレータに対する制御情報に基づいて前記マニピュレータの動作状態を特定し、このマニピュレータの複数の代表点を設定し、これら中心点及び各代表点間の距離を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項８記載のロボット装置の制御方法。
【請求項１２】
前記侵入物体の監視結果に基づいて、前記侵入物体の水平面への投影図形の中心点及び水平面上において前記中心点から一定の距離の点を包絡した近似図形を設定するとともに、前記マニピュレータを監視することにより前記マニピュレータの動作状態を特定し前記マニピュレータの水平面への投影図形を設定し、これら近似図形及び投影図形の干渉の有無を判定することにより、前記マニピュレータと前記侵入物体との距離が所定の距離以下となったことを判別する
ことを特徴とする請求項８記載のロボット装置の制御方法。
【請求項１３】
前記マニピュレータがワークを把持している場合には、把持されているワークの大きさに応じて、前記警戒領域、前記近似立体、または、前記近似図形を拡大する
ことを特徴とする請求項８、請求項９、請求項１０、または、請求項１２記載のロボット装置の制御方法。
【請求項１４】
前記侵入物体を包括する警戒領域を設定し、この警戒領域及び前記マニピュレータの可動領域を包括する前記警戒領域の少なくとも一方について、これら警戒領域よりも狭い一、または、二以上に多重化された危険領域を設定して多重化し、
前記侵入物体領域と前記マニピュレータとの警戒領域同士が重なった場合には、第１段階の減速を行い、一方の危険領域と他方の警戒領域とが重なった場合には、前記侵入物体領域と前記マニピュレータとの接近に応じて順次多段的に減速する
ことを特徴とする請求項８、請求項９、請求項１０、または、請求項１２記載のロボット装置の制御方法。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【公開番号】特開２０１０−２０８００２（Ｐ２０１０−２０８００２Ａ）
【公開日】平成２２年９月２４日（２０１０．９．２４）
【国際特許分類】
【出願番号】特願２００９−５９８４９（Ｐ２００９−５９８４９）
【出願日】平成２１年３月１２日（２００９．３．１２）
【出願人】（０００００００９９）株式会社ＩＨＩ (5,014)
【Ｆターム（参考）】
【公開日】平成２２年９月２４日（２０１０．９．２４）
【国際特許分類】
【出願日】平成２１年３月１２日（２００９．３．１２）
【出願人】（０００００００９９）株式会社ＩＨＩ (5,014)
【Ｆターム（参考）】
[ Back to top ]