JP6466536B1 - パラレルリンク機構を用いた作業装置 - Google Patents

Abstract

【課題】エンドエフェクタの作業点が移動せず、姿勢のみが変更される場合や、エンドエフェクタの作業点の移動が微小で、かつエンドエフェクタの姿勢を大きく変更する場合でも、作業装置全体が急に高速で動くことを防止でき、作業経験が少ない作業者でも安心して扱うことができるようにする。【解決手段】リンク作動装置７と他のアクチュエータ７１とを組み合わせた作業装置１に適用される。制御装置２の複数の作業座標を記憶する記憶部３に、エンドエフェクタ６の目標速度である作業点移動速度と、前記エンドエフェクタ６の姿勢を変更するために設定する目標角速度である姿勢変更速度とを記憶する。制御部４は、各姿勢制御用のアクチュエータ１１１，１１２，１１３の移動速度および前記組み合わせ側のアクチュエータ７１の移動速度を計算するときに用いる目標速度を、作業点移動速度と前記姿勢変更速度とに切り替える切替え機能部４ａを有する。【選択図】図１

Description

この発明は、産業機器等の精密で広範な作動範囲を必要とする機器等に用いられるパラレルリンク機構を用いた作業装置に関する。

コンパクトな構成でありながら、精密で広範な作動範囲の動作が可能なリンク作動装置として、例えば、特許文献１に示されるような構成が提案されている。
このようなリンク作動装置の先端にエンドエフェクタを搭載し、エンドエフェクタが作業を行う作業空間上の複数の作業点を連続的に移動させる際の制御方法として、特許文献２に示される構成が提案されている。
また、特許文献２に示されるようなリンク作動装置と直動機構を組み合わせた特許文献３に示される構成が提案されている。

この他に、特許文献４に、多関節のロボットの制御装置として、監視点情報を記憶するパラメータ記憶部と、移動指令に基づいて支柱や各関節点等の動作を生成する軌跡生成部と、支柱や各関節点等の制御点の速度を求める制御点速度制御部と、制御点の動作速度から発生する監視点の速度を求める監視点速度制御部と、制御点の速度と監視点の速度から最大速度を選択し、指令速度と比較して、最大速度が指令速度を超えた場合に、制御点の速度を指令速度に変更制御する動作指令部とを備えた構成が提案されている。

特許５７８５０５５号公報 特開２０１５−１５５１２４号公報 特開２０１５−１８８９４５号公報 国際公開ＷＯ０２／０６６２１０

特許文献３で示されるような、リンク作動装置と１軸以上のアクチュエータを組み合わせたパラレルリンク機構を用いた作業装置では、エンドエフェクタの作業点が移動せず、エンドエフェクタの姿勢のみが変更される場合がある。しかし、特許文献２で示されている制御方法は、複数のエンドエフェクタの作業点を連続的に等速で移動させるものであり、エンドエフェクタ６の作業点が移動せず、エンドエフェクタの姿勢のみが変更される場合には適用できない。
また、複数のエンドエフェクタの作業点を連続的に等速で移動させていく場合に、経路の途中に、先端位置の移動量が微小で姿勢だけを大きく変更する区間が存在する場合があるが、このような場合に、先端位置の速度を指令するのでは、その区間では移動時間が短くなることで、多関節ロボットの特異姿勢のように作業装置全体が急に高速で動きだし、モータが破損するだけでなく、作業者に危害を与える可能性がある。

この発明の目的は、エンドエフェクタの作業点が移動せず、エンドエフェクタの姿勢のみが変更される場合や、エンドエフェクタの作業点の移動が微小で、かつエンドエフェクタの姿勢を大きく変更する場合でも、作業装置全体が急に高速で動くことを防止でき、作業経験が少ない作業者でも安心して扱うことができるパラレルリンク機構を用いた作業装置を提供することである。

この発明のパラレルリンク機構１０を用いた作業装置１は、基端側のリンクハブ１２に対し先端側のリンクハブ１３が３組以上のリンク機構１４を介して姿勢を変更可能に連結され、前記各リンク機構１４は、それぞれ前記基端側のリンクハブ１２および前記先端側のリンクハブ１３に一端が回転可能に連結された基端側および先端側の端部リンク部材と、これら基端側および先端側の端部リンク部材の他端に両端がそれぞれ回転可能に連結された中央リンク部材とを有し、前記３組以上のリンク機構１４のうち２組以上のリンク機構１４に、前記基端側のリンクハブ１２に対する前記先端側のリンクハブ１３の姿勢を変更させる姿勢制御用のアクチュエータ１１（１１_１，１１_２，１１_３）が設けられたリンク作動装置７と、
前記先端側のリンクハブ１３に取付けられたエンドエフェクタ６と、
前記リンク作動装置７と組み合わせられて前記エンドエフェクタ６の作業点Ｐと前記リンク作動装置７の基準位置とを相対的に変更する１軸以上の組み合わせ側のアクチュエータ７１〜７３，８５〜８７，９５〜９７と、
前記姿勢制御用のアクチュエータ１１および前記組み合わせ側のアクチュエータ７１〜７３，８５〜８７，９５〜９７を制御する制御装置２とを備えたパラレルリンク機構１０を用いた作業装置であって、
前記制御装置２は、
前記エンドエフェクタ６が作業する作業空間上の各作業点Ｐ_ｉ（ｉ＝０，１，２，…）の座標である複数の作業座標（Ｘ_Ｐｉ，Ｙ_Ｐｉ，Ｚ_Ｐｉ）を記憶しておく記憶部３と、
この記憶部３に記憶された前記作業座標（Ｘ_Ｐｉ，Ｙ_Ｐｉ，Ｚ_Ｐｉ）から、前記各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７の移動量および作業座標（（Ｘ_Ｐｉ，Ｙ_Ｐｉ，Ｚ_Ｐｉ）間の距離を計算、さらに所定の目標速度を用いて前記各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７の移動速度とを計算し、計算された前記各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７の移動量および移動速度で前記各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７を動作させる制御部４とを有し、
前記記憶部３に、前記目標速度として、前記作業座標（Ｘ_Ｐｉ，Ｙ_Ｐｉ，Ｚ_Ｐｉ）間を連続的に等速で移動するために設定する所定の作業点移動速度と、前記エンドエフェクタ６の姿勢を所定の角速度で変更するために設定する姿勢変更速度とを記憶し、
前記制御部４は、前記目標速度を、前記作業点移動速度と前記姿勢変更速度とに切り替える切替え機能部４ａを有する。
なお、前記「作業点移動速度」および「姿勢変更速度」は、設計により任意に定められる値である。

上記構成の作業装置を動作させる場合において、エンドエフェクタ６の作業点Ｐの移動が微小で、かつエンドエフェクタ６の姿勢を大きく変更する場合、エンドエフェクタ６の作業点Ｐを連続的に移動する際の所定の目標速度である作業点移動速度で動作させようとすると、エンドエフェクタ６の姿勢を変更するための速度が過大となってしまい、作業装置全体が急に高速で動く恐れがある。しかし、この作業装置１は、前記切替え機能部を有していて、作業点移動速度から姿勢変更速度に切り替えることができ、その切り替を行って作業点移動速度よりも遅い姿勢変更速度とすることで、作業装置全体が急に高速で動くことを防止できる。

例えば、前記パラレルリンク機構１０と１軸以上の組み合わせ側のアクチュエータ７１〜７３，８５〜８７，９５〜９７とを組み合わせた前記作業装置１の構成において、姿勢を姿勢Ａから姿勢Ｂへ変更し、前記組み合わせ側のアクチュエータ７１〜７３，８５〜８７，９５〜９７の位置を位置Ｃから位置Ｄへ変更するとき、リンク作動装置７の先端に搭載したエンドエフェクタ６の作業点がＰからＱに変更されるとする。なお、前記作業点Ｐ_ｉのうちの任意の一つを「Ｐ」と称し、他の一つを「Ｑ」と称している。また、位置を特定せずに作業点を言う場合に「作業点Ｐ」と称する場合がある。
この過程で、エンドエフェクタ６の作業点Ｐが変化せず（Ｐ＝Ｑ）、パラレルリンク機構１０の姿勢が変更される（Ａ≠Ｂとなる）場合に、所定の角速度である前記姿勢変更速度で姿勢を変更するように、前記パラレルリンク機構１０の持つアクチュエータ１１と前記組み合わせ側のアクチュエータ７１〜７３，８５〜８７，９５〜９７の移動量を制御する。
具体的には、∠ＡＰＢ（＝∠ＡＱＢ）とオペレータが予め設定する姿勢変更速度から姿勢変更にかかる時間(1) を計算し、姿勢Ａから姿勢Ｂに姿勢変更（同時に位置Ｃから位置Ｄへ移動）する際の各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７の移動量(2) をそれぞれ求め、各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７の移動速度を計算する。（移動速度＝移動量÷時間＝(2) ÷(1) ）
これにより、エンドエフェクタ６の複数の作業点Ｐを連続的に移動させる途中に、エンドエフェクタ６の作業点Ｐが移動せず、エンドエフェクタ６の姿勢のみが変更される区間が存在する場合でも各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７の移動速度を制御できる。

この発明において、前記切替え機能部４ａは、前記目標速度を、前記エンドエフェクタ６の移動距離が移動距離閾値を上回る場合は前記作業点移動速度とし、前記移動距離閾値を下回る場合は前記姿勢変更速度とするようにしてもよい。上回るか下回るかは、「以上，未満」で判断しても、また「超える，以下」で判断してもよい。
ここで、エンドエフェクタ６の作業点Ｐが移動しないもしくは移動が微小であるとは、エンドエフェクタ６の作業点Ｐの移動距離が、予め規定しておいた前記「移動距離閾値」の範囲内であるかどうかで判断する。
エンドエフェクタ６の作業点Ｐの移動が微小で、かつエンドエフェクタ６の姿勢を大きく変更する場合、エンドエフェクタ６の作業点Ｐを連続的に移動する際の所定の目標速度（前記「作業点移動速度」）で動作させようとすると、エンドエフェクタ６の姿勢を変更するための速度が過大となってしまい、作業装置全体が急に高速で動く恐れがある。しかし、この移動距離閾値を用いて作業点移動速度から姿勢変更速度に自動で切り替えることで、経験が浅い作業者でも作業装置全体が急に高速で動くことを防止できる。

この発明において、前記切替え機能部４ａは、前記目標速度を、前記作業点移動速度から計算した前記各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７の移動速度のうちの少なくとも一つが速度閾値を上回ると言う速度条件を満足する場合は前記姿勢変更速度とし、前記速度条件を満足しない場合は前記作業点移動速度とするようにしてもよい。
すなわち、作業点移動速度から姿勢変更速度に自動で切り替える方法として、作業点移動速度から計算した各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７の移動速度が各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７の定格速度を超えてしまう場合に、自動で切り替えるようにしてもよい。これにより、作業装置１の全体が急に高速で動くことを防止するだけでなく、各アクチュエータ１１，７１〜７３，８５〜８７，９５〜９７が破損することを防止できる。

この発明において、前記目標速度として前記作業点移動速度と前記姿勢変更速度とをオペレータの操作で任意に切り替え可能とする切替スイッチ５を有するようにしてもよい。 作業点移動速度から姿勢変更速度に自動で切り替える構成として、オペレータが任意で切り替えることのできる切替スイッチ５を設けることによって、エンドエフェクタ６の作業点Ｐの移動が移動距離閾値の範囲外であった場合にも姿勢変更速度へ変更可能とすることで、オペレータが任意で作業点移動速度と姿勢変更速度とを切り替えることができる。

この発明のパラレルリンク機構を用いた作業装置は、基端側のリンクハブに対し先端側のリンクハブが３組以上のリンク機構を介して姿勢を変更可能に連結され、前記各リンク機構は、それぞれ前記基端側のリンクハブおよび前記先端側のリンクハブに一端が回転可能に連結された基端側および先端側の端部リンク部材と、これら基端側および先端側の端
部リンク部材の他端に両端がそれぞれ回転可能に連結された中央リンク部材とを有し、前記３組以上のリンク機構のうち２組以上のリンク機構に、前記基端側のリンクハブに対する前記先端側のリンクハブの姿勢を変更させる姿勢制御用のアクチュエータが設けられたリンク作動装置と、前記先端側のリンクハブに取付けられたエンドエフェクタと、前記リンク作動装置と組み合わせられて前記エンドエフェクタの作業点と前記リンク作動装置の基準位置とを相対的に変更する１軸以上の組み合わせ側のアクチュエータと、前記姿勢制御用のアクチュエータおよび前記組み合わせ側のアクチュエータを制御する制御装置とを備え、前記制御装置は、前記エンドエフェクタが作業する作業空間上の各作業点の座標である複数の作業座標を記憶しておく記憶部と、この記憶部に記憶された前記作業座標から、前記各アクチュエータの移動量および作業座標間の距離を計算し、さらに所定の目標速度を用いて前記各アクチュエータの移動速度を計算し、計算された前記各アクチュエータの移動量および移動速度で前記各アクチュエータを動作させる制御部とを有し、前記記憶部に、前記目標速度として、前記作業座標間を連続的に等速で移動するために設定する所定の作業点移動速度と、前記エンドエフェクタの姿勢を所定の角速度で変更するために設定する姿勢変更速度とを記憶し、前記制御部は、前記目標速度を、前記作業点移動速度と前記姿勢変更速度とに切り替える切替え機能部を有するため、エンドエフェクタの作業点が移動せず、エンドエフェクタの姿勢のみが変更される場合や、エンドエフェクタの作業点の移動が微小で、かつエンドエフェクタの姿勢を大きく変更する場合でも、作業装置全体が急に高速で動くことを防止でき、作業経験が少ない作業者でも安心して扱うことができる。また、アクチュエータの破損も防止できる。

この発明の第１の実施形態に係るパラレルリンク機構を用いた作業装置の斜視図に制御装置のブロック図を組み合わせた説明図である。 同作業装置の動作の説明図である。 同作業装置の他の動作の説明図である。 同作業装置における制御装置が行う制御の一例を示すフロー図である。 第２の実施形態に係る作業装置における制御装置が行う制御の他の例を示すフロー図である。 第３の実施形態に係る作業装置における制御装置が行う制御のさらに他の例を示すフロー図である。 第４の実施形態に係る作業装置における制御装置が行う制御のさらに他の例を示すフロー図である。 さらに他の実施形態に係るパラレルリンク機構を用いた作業装置の斜視図である。 さらに他の実施形態に係るパラレルリンク機構を用いた作業装置の斜視図である。 さらに他の実施形態に係るパラレルリンク機構を用いた作業装置の斜視図である。 さらに他の実施形態に係るパラレルリンク機構を用いた作業装置の斜視図である。 さらに他の実施形態に係るパラレルリンク機構を用いた作業装置の斜視図である。 さらに他の実施形態に係るパラレルリンク機構を用いた作業装置の斜視図である。 第１の実施形態に係る作業装置におけるリンク作動装置の一部を示す正面図である。 同リンク作動装置の一つの動作状態を示す斜視図である。 同リンク作動装置の他の動作状態を示す斜視図である。 図１４のXVII−XVII断面図である。 同リンク作動装置を直線で示すモデル図である。

この発明の実施形態を図面と共に説明する。
〔第１の実施形態〕
図１〜図４、および図１４〜１８は、この発明の第１の実施形態を示す。このパラレルリンク機構を用いた作業装置１は、パラレルリンク機構１０およびその姿勢制御用のアクチュエータ１１（１１_１，１１_２，１１_３）により構成されるリンク作動装置７と、このリンク作動装置７と組み合わせられる組み合わせ機構７０を構成する１軸の組み合わせ側のアクチュエータ７１と、エンドエフェクタ６と、制御装置２とを備える。前記姿勢制御用のアクチュエータ１１は、図１では模式的に示している。

前記組み合わせ側のアクチュエータ７１は、単独で前記組み合わせ機構７０を構成する１軸の直動アクチュエータであり、架設されたレール７１ｂに沿って左右方向（Ｘ軸方向）に移動台７１ｃを進退自在に設置し、この移動台７１ｃを駆動源となるモータ７１ａで進退させる。モータ７１ａの回転は、ボールねじまたはラック・ピニオン機構等の回転・直線運動変換機構（図示せず）を介して、前記移動台７１ｃとレール７１ｂ間に伝達される。モータ７１ａは、移動台７１ｃに搭載されていても、レール７１に設置されていてもよい。前記移動台７１ｃの下面に、前記リンク作動装置７がその基端側リンクハブ１２を固定して設置されている。

リンク作動装置７について詳しく説明する。リンク作動装置７のパラレルリンク機構１０は、図１５，１６に示すように、基端側のリンクハブ１２に対し先端側のリンクハブ１３を、３組のリンク機構１４を介して姿勢変更可能に連結してなる。リンク機構１４の数は、４組以上であってもよい。

各リンク機構１４は、その一つを図１４に示すように、基端側の端部リンク部材１５、先端側の端部リンク部材１６、および中央リンク部材１７で構成され、４つの回転対偶からなる４節連鎖のリンク機構をなす。基端側および先端側の端部リンク部材１５，１６はＬ字状をなし、一端がそれぞれ基端側のリンクハブ１２および先端側のリンクハブ１３に回転自在に連結されている。中央リンク部材１７は、両端に基端側および先端側の端部リンク部材１５，１６の他端がそれぞれ回転自在に連結されている。

パラレルリンク機構１０は、２つの球面リンク機構を組み合わせた構造であって、リンクハブ１２，１３と端部リンク部材１５，１６の各回転対偶、および端部リンク部材１５，１６と中央リンク部材１７の各回転対偶の中心軸が、基端側と先端側においてそれぞれの球面リンク中心ＰＡ，ＰＢで交差している。また、基端側と先端側において、リンクハブ１２，１３と端部リンク部材１５，１６の各回転対偶とそれぞれの球面リンク中心ＰＡ，ＰＢからの距離も同じであり、端部リンク部材１５，１６と中央リンク部材１７の各回転対偶とそれぞれの球面リンク中心ＰＡ，ＰＢからの距離も同じである。端部リンク部材１５，１６と中央リンク部材１７との各回転対偶の中心軸は、ある交差角γを持っていてもよいし、平行であってもよい。

図１７は図１４のXVII−XVII断面図であって、同図に、基端側のリンクハブ１２と基端側の端部リンク部材１５の各回転対偶の中心軸Ｏ１と、中央リンク部材１７と基端側の端部リンク部材１５の各回転対偶の中心軸Ｏ２と、基端側の球面リンク中心ＰＡとの関係が示されている。つまり、中心軸Ｏ１と中心軸Ｏ２とが交差する点が球面リンク中心ＰＡである。先端側のリンクハブ１３および先端側の端部リンク部材１６の形状ならびに位置関係も図１５と同様である（図示せず）。図の例では、リンクハブ１２（１３）と端部リンク部材１５（１６）との各回転対偶の中心軸Ｏ１と、端部リンク部材１５（１６）と中央リンク部材１７との各回転対偶の中心軸Ｏ２とが成す角度αが９０°とされているが、前記角度αは９０°以外であってもよい。

３組のリンク機構１４は、幾何学的に同一形状をなす。幾何学的に同一形状とは、図１８に示すように、各リンク部材１５，１６，１７を直線で表現した幾何学モデル、すなわち各回転対偶と、これら回転対偶間を結ぶ直線とで表現したモデルが、中央リンク部材１７の中央部に対する基端側部分と先端側部分が対称を成す形状であることを言う。図１８は、一組のリンク機構１４を直線で表現した図である。この実施形態のパラレルリンク機構１０は回転対称タイプで、基端側のリンクハブ１２および基端側の端部リンク部材１５と、先端側のリンクハブ１３および先端側の端部リンク部材１６との位置関係が、中央リンク部材１７の中心線Ｃに対して回転対称となる位置構成になっている。各中央リンク部材１７の中央部は、共通の軌道円上に位置している。

基端側のリンクハブ１２と先端側のリンクハブ１３と３組のリンク機構１４とで、基端側のリンクハブ１２に対し先端側のリンクハブ１３が直交２軸回りに回転自在な２自由度機構が構成される。言い換えると、基端側のリンクハブ１２に対して先端側のリンクハブ１３を、回転が２自由度で姿勢変更自在な機構である。この２自由度機構は、コンパクトでありながら、基端側のリンクハブ１２に対する先端側のリンクハブ１３の可動範囲を広くとれる。

例えば、球面リンク中心ＰＡ，ＰＢを通り、リンクハブ１２，１３と端部リンク部材１５，１６の各回転対偶の中心軸Ｏ１（図１８）と直角に交わる直線をリンクハブ１２，１３の中心軸ＱＡ，ＱＢとした場合、基端側のリンクハブ１２の中心軸ＱＡと先端側のリンクハブ１３の中心軸ＱＢとの折れ角θの最大値を約±９０°とすることができる。また、基端側のリンクハブ１２に対する先端側のリンクハブ１３の旋回角φを０°〜３６０°の範囲に設定できる。折れ角θは、基端側のリンクハブ１２の中心軸ＱＡに対して先端側のリンクハブ１３の中心軸ＱＢが傾斜した垂直角度のことであり、旋回角φは、基端側のリンクハブ１２の中心軸ＱＡに対して先端側のリンクハブ１３の中心軸ＱＢが傾斜した水平角度のことである。

基端側のリンクハブ１２に対する先端側のリンクハブ１３の姿勢変更は、基端側のリンクハブ１２の中心軸ＱＡと先端側のリンクハブ１３の中心軸ＱＢとの交点Ｏを回転中心として行われる。基端側のリンクハブ１２の中心軸ＱＡと先端側のリンクハブ１３の中心軸ＱＢが同一線上にある原点位置の状態（図１５）では、先端側のリンクハブ１３は真下を向く。図１，図１６は、基端側のリンクハブ１２の中心軸ＱＡに対して先端側のリンクハブ１３の中心軸ＱＢが或る作動角をとった状態を示す。姿勢が変化しても、基端側と先端側の球面リンク中心ＰＡ，ＰＢ間の距離Ｌ（図１８）は変化しない。

各リンク機構１４が次の各条件を満たす場合、幾何学的対称性から基端側のリンクハブ１２および基端側の端部リンク部材１５と、先端側のリンクハブ１３および先端側の端部リンク部材１６とは同じに動く。よって、パラレルリンク機構１０は、基端側から先端側へ回転伝達を行う場合、基端側と先端側は同じ回転角になって等速で回転する等速自在継手として機能する。
条件１：各リンク機構１４におけるリンクハブ１２，１３と端部リンク部材１５，１６との回転対偶の中心軸Ｏ１の角度および長さが互いに等しい。
条件２：リンクハブ１２，１３と端部リンク部材１５，１６との回転対偶の中心軸Ｏ１および端部リンク部材１５，１６と中央リンク部材１７との回転対偶の中心軸Ｏ２が、基端側および先端側において球面リンク中心ＰＡ，ＰＢで交差する。
条件３：基端側の端部リンク部材１５と先端側の端部リンク部材１６の幾何学的形状が等しい。
条件４：中央リンク部材１７における基端側部分と先端側部分の幾何学的形状が等しい。
条件５：中央リンク部材１７の対称面に対して、中央リンク部材１７と端部リンク部材１５，１６との角度位置関係が基端側と先端側とで同じである。

図１５に示すように、基端側のリンクハブ１２は、基端部材２０と、この基端部材２０と一体に設けられた３個の回転軸連結部材２１とで構成される。基端部材２０は中央部に円形の貫通孔２０ａ（図１７参照）を有し、この貫通孔２０ａの周囲に３個の回転軸連結部材２１が円周方向に等間隔で配置されている。貫通孔２０ａの中心は、基端側のリンクハブ１２の中心軸ＱＡ（図１４）上に位置する。各回転軸連結部材２１には、軸心が基端側のリンクハブ１２の中心軸ＱＡと交差する回転軸２２が回転自在に連結されている。この回転軸２２に、基端側の端部リンク部材１５の一端が連結される。

図１５に示すように、先端側のリンクハブ１３は、平板状の先端部材５０と、この先端部材５０の内面に円周方向等配で設けられた３個の回転軸連結部材５１とで構成される。３個の回転軸連結部材５１が配置される円周の中心は、先端側のリンクハブ１３の中心軸ＱＢ上に位置する。各回転軸連結部材５１は、軸心が先端側のリンクハブ１３の中心軸ＱＢと交差する回転軸５２が回転自在に連結されている。この先端側のリンクハブ１３の回転軸５２に、先端側の端部リンク部材１６の一端が連結される。先端側の端部リンク部材１６の他端には、中央リンク部材１７の他端に回転自在に連結された回転軸５５が連結される。先端側のリンクハブ１３の回転軸５２および中央リンク部材１７の回転軸５５も、前記回転軸３５と同じ形状であり、かつ２個の軸受（図示せず）を介して回転軸連結部材５１および中央リンク部材１７の他端にそれぞれ回転自在に連結されている。

リンク作動装置７の姿勢制御用のアクチュエータ１１は、減速機構６２を備えたロータリアクチュエータであり、基端側のリンクハブ１２の基端部材２０の下面に、前記回転軸２２と同軸上に設置されている。姿勢制御用アクチュエータ１１と減速機構６２は一体に設けられ、モータ固定部材６３により減速機構６２が基端部材２０に固定されている。この例では、３組のリンク機構１４の全てに姿勢制御用アクチュエータ１１が設けられているが、３組のリンク機構１４のうち少なくとも２組に姿勢制御用アクチュエータ１１を設ければ、基端側のリンクハブ１２に対する先端側のリンクハブ１３の姿勢を確定することができる。

リンク作動装置７は、各姿勢制御用アクチュエータ１１を回転駆動することで、パラレルリンク機構１０が作動する。詳しくは、姿勢制御用アクチュエータ１１を回転駆動すると、その回転が減速機構６２を介して減速して回転軸２２に伝達される。それにより、基端側のリンクハブ１２に対する基端側の端部リンク部材１５の角度が変わり、基端側のリンクハブ２に対する先端側のリンクハブ３の姿勢が変更される。

図１において、エンドエフェクタ６は、この作業装置１により対象物（図示せず）に対して作業を行う装置であって、例えば、塗布ノズル、エアーノズル、溶接トーチ、カメラ、把持機構等とされる。
エンドエフェクタ６は、同図の例では、先端側のリンクハブ１３に中心軸ＱＢに沿って突出して設けられ、先端が作業点Ｐとなる装置、例えば塗布ノズルとされている。エンドエフェクタ６は、作業点Ｐがこのエンドエフェクタ６の先端から中心軸ＱＢの延長方向に離れていてもよい。

制御装置２は、前記姿勢制御用のアクチュエータ１１（１１_１〜１１_３）および前記組み合わせ側のアクチュエータ７１を制御する装置であって、コンピュータおよびこれに実行されるプログラム、並びに電子回路等からなり、記憶部３、制御部４、および切替スイッチ５を有する。制御部４は切替え機能部４ａを有する。

記憶部３は、エンドエフェクタ６が作業する作業空間Ｓ上の作業点Ｐ_ｉ（ｉ＝０，１，２，３，…）の座標である複数の作業座標（Ｘ_Ｐｉ，Ｙ_Ｐｉ，Ｚ_Ｐｉ）を記憶しておく手段であり、これに加えて作業点移動速度および姿勢変更速度を記憶する。
作業点移動速度は、エンドエフェクタ６が作業する作業空間Ｓ上の前記座標（Ｘ_Ｐｉ，Ｙ_Ｐｉ，Ｚ_Ｐｉ）を連続的に等速で移動するために設定する所定の目標速度であり、任意の値に設定される。
姿勢変更速度は、前記エンドエフェクタ６の姿勢を所定の速度で変更するために設定する所定の目標角速度であり、任意の値に設定される。

制御部４は、記憶部３に記憶された作業座標から、各姿勢制御用のアクチュエータ１１および前記組み合わせ側のアクチュエータ７１の移動量および作業座標間の距離を計算し、かつ所定の目標速度から前記各アクチュエータ１１，７１の移動速度を計算し、計算された前記各アクチュエータ１１，７１の移動量および移動速度で前記各アクチュエータ１１，７１を動作させる。

切替え機能部４ａは、前記各姿勢制御用のアクチュエータ１１の移動速度および前記組み合わせ側のアクチュエータ７１の移動速度を計算するときに用いる前記所定の目標速度を、前記作業点移動速度と前記姿勢変更速度とに、定められた条件に応じて自動で切り替える手段である。

切替え機能部４ａは、例えば、前記目標速度を、エンドエフェクタ６の移動距離が、判断基準距離として定められた移動距離閾値を上回る場合は前記作業点移動速度とし、前記移動距離閾値を下回る場合は前記姿勢変更速度とするようにしてもよい。
また、切替え機能部４ａは、前記目標速度を、前記作業点移動速度から計算した前記各アクチュエータ１１，７１の移動速度のうちの少なくとも一つが判断基準速度として定められた速度閾値を上回ると言う速度条件を満足する場合は前記姿勢変更速度とし、前記速度条件を満足しない場合は前記作業点移動速度とするようにしてもよい。

切替スイッチ５は、目標速度として前記作業点移動速度と前記姿勢変更速度とをオペレータの操作で任意に切り替え可能とするための入力操作手段である。

以下、上記構成の動作例、および構成の補足説明を行う。
図１は、リンク作動装置７と前記他の直動１軸のアクチュエータ７１とを組み合わせたときの構成例である。この構成において、リンク作動装置７の姿勢Ａ（θa ，φa ）のときの姿勢変更用の３つの各アクチュエータ１１（１１_１，１１_２，１１_３）の位置を（β1a，β2a，β3a）とする。また、前記組み合わせ側のアクチュエータ７１の位置Ｃ（図２参照）における移動量をＭｃとする。このとき、リンク作動装置７の先端に配置したエンドエフェクタ６の作業点Ｐの作業空間Ｓにおける座標を（Xp，Yp，Zp）とする。
なお、説明の簡明のために、前記作業点Ｐ_ｉのうちの任意の一つを「Ｐ」と称し、他の一つを「Ｑ」と称して図上に示している。また、特にどの作業点Ｐ_ｉであるかを特定しない場合において、単に「作業点Ｐ」と称することがある。

図２にリンク作動装置７の姿勢を姿勢Ａ（θa，φa）から姿勢Ｂ（θb，φb）へ変更し、他の直動１軸のアクチュエータ７１位置を位置Ｃ（Ｍｃ）から位置Ｄ（Ｍｄ）へ変更したとき、エンドエフェクタ６の作業点Ｐが座標（X_ｐ，Y_ｐ，Z_ｐ）から（X_ｑ，Y_ｑ，Z_ｑ）に移動する場合を示す。
このときの座標移動距離Ｌ、所定の作業点移動速度をＶ１とすると、移動する際にかかる時間Ｔ１は次の（式１）で表せる。

よって、各アクチュエータ１１_１，１１_２，１１_３，７１の移動量を、Δβ１、Δβ2 、Δβ3 、ΔＭとすると、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度は以下の（式２）で表せる。

図３に、リンク作動装置７の姿勢を姿勢Ａ（θa，φa）から姿勢Ｂ（θb，φb）へ変更し、他の直動１軸のアクチュエータ７１の位置を位置Ｃ（Ｍｃ）から位置Ｄ（Ｍｄ）へ変更したとき、エンドエフェクタ６の作業点がＰのまま移動しなかった（ＰとＱが一致する）場合を示す。このときの姿勢Ａと姿勢Ｂがなす角度をγ、所定の姿勢変更速度をＶ２とすると、移動する際にかかる時間Ｔ２は次の（式３）で表せる。

よって、各アクチュエータ１１_１，１１_２，１１_３，７１の移動量を、Δβ１、Δβ2 、Δβ3 、ΔＭとすると、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度は以下の（式４）で表せる。

（式１）、（式２）と（式３）、（式４）とを切り替えることで、エンドエフェクタ６の作業点Ｐを所定の作業点移動速度で移動させる動作と、エンドエフェクタ６の姿勢を所定の姿勢変更速度で変更する動作を連続的な動作の中で切り替えることができる。

図４〜図７に、図１の制御部４が切替え機能部４ａを用いて各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を切り替えるフローの各例を示す。
図４において、判断基準となる所定の速度、つまり速度閾値を上回る速度で作業点を移動させるか否かを判断し（ステップＲ１）、条件を満足する場合は作業点移動速度を目標速度（ステップＲ２）とする。
この後、制御部４は、作業点移動距離から前記作業点移動速度で移動させる場合の時間を求め（ステップＲ３）、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を計算する（ステップＲ４）。

ステップＲ１の判断時に、速度閾値を上回る速度で作業点Ｐを移動させない場合は、姿勢変更速度を目標速度とする（ステップＲ５）。姿勢変更角度から前記姿勢変更速度で姿勢変更した場合の時間を求め（ステップＲ６）、各アクチュエータ１１_１，１１_２，１１_３
，７１の移動速度を計算する（ステップＲ４）。

＜実施形態２、図５＞
ここで、厳密には作業点Ｐと作業点Ｑが一致していなくても、（式１）に示す作業点Ｐと作業点Ｑの間の座標移動距離Ｌが所定の移動距離閾値Ｔｈ＿pos の範囲内にある場合、すなわち（式５）を満たす場合には、エンドエフェクタ６の作業点がＰから移動しないとみなし、姿勢変更速度で各アクチュエータ１１_１，１１_２，１１_３，７１の速度を計算する。
Ｌ≦Ｔｈ＿pos ・・・（式５）

エンドエフェクタ６の作業点Ｐの移動が微小で、かつエンドエフェクタ６の姿勢を大きく変更する場合、エンドエフェクタ６の作業点Ｐを連続的に移動する際の所定の作業点移動速度で動作させようとすると、エンドエフェクタ６の姿勢を変更するための速度が過大となってしまい、作業装置１の全体が急に高速で動く恐れがある。しかし、この移動距離閾値を設けることで作業点移動速度から姿勢変更速度に自動で切り替えることができ、作業装置１の全体が急に高速で動くことを防止できる。

図５に、移動距離閾値Ｔｈ＿pos を用いて各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を切り替えるフローを示す。
作業点移動距離Ｌを計算し（ステップＵ１）、作業点移動距離Ｌが移動距離閾値Ｔｈ＿pos 以下であるかを判断し（ステップＵ２）、条件満足の場合は姿勢変更速度を目標速度とする（ステップ３）。姿勢変更角度から、前記姿勢変更速度で動作させた場合の時間を求め（ステップＵ４）、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を計算する（ステップＵ５）。

ステップＵ２の判断で条件を満足しない場合は、ステップＵ６に進んで作業点移動速度を目標速度とする。この後、作業点移動距離から、前記作業点移動速度で動作させた場合の時間を求め（ステップＵ７）、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を計算する（ステップＵ５）。

＜実施形態３、図６＞
作業点Ｐと作業点Ｑの間の座標移動距離Ｌ、所定の作業点移動速度Ｖ１、および各アクチュエータ１１_１，１１_２，１１_３，７１の移動量から計算された各アクチュエータ１１_１，１１_２，１１_３，７１のうちのいずれかのアクチュエータ１１_１，１１_２，１１_３，７１の移動速度が所定の速度閾値Ｔｈ＿vel を超える場合に、姿勢変更速度から各アクチュエータ１１_１，１１_２，１１_３，７１の速度を計算する。これにより、作業点Ｐと作業点Ｑの間の座標移動距離Ｌが所定の移動距離閾値Ｔｈ＿pos の範囲外であっても、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度が過大となることを防止することができる。仮に所定の速度閾値を各アクチュエータ１１_１，１１_２，１１_３，７１の定格速度とすれば、作業装置全体が急に高速で動くことを防止するだけでなく、アクチュエータの破損も防止できる。

図６に、上記のように速度閾値Ｔｈ＿vel を用いて各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を切り替えるフローを示す。
作業点移動速度Ｖ１を目標速度とし（ステップＷ１）、作業点移動距離（座標移動距離Ｌ）から、前記作業点移動速度Ｖ１で動作した場合の時間を求め（ステップＷ２）、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度Ｖact を計算する（ステップＷ３）。

全アクチュエータ１１_１，１１_２，１１_３，７１において、移動速度Ｖact ≦Ｔｈ＿vel を満たすかを判断し（ステップＷ４）、満たす場合は前記移動速度Ｖact で各アクチュエータ１１_１，１１_２，１１_３，７１を動作させる。

前記判断ステップＷ４で条件を満たさない場合は、ステップＷ５に進んで姿勢変更速度を目標速度とする。姿勢変更角度から前記姿勢変更速度で動作させた場合の時間を求め（Ｗ６）、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を計算する（ステップＷ７）。

＜実施形態４、図７＞
オペレータが操作することが可能な前記切替スイッチ５を前述のように設け、制御部４は、この切替スイッチ５により作業点移動速度と姿勢変更速度を任意に切り替え可能として、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を切り替えられるようにしてもよい。この場合に、作業点Ｐ_ｉごとに切替スイッチ５による切り替えを可能として各作業点Ｐ_ｉにおける切り替え結果を記憶するようにしてもよい。
これにより、作業点Ｐ_ｉを連続的に移動する途中の区間でエンドエフェクタ６の姿勢を所定の角速度で変更したい場合にも、容易に変更できる。

図７に、切替スイッチ５を用いて各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を切り替えるフローを示す。
ステップＮ１では所定の角速度で姿勢を変更させることが選択されているか、つまり切替スイッチ５で姿勢変更速度とすることが選択された切替状態となっているかを判断し、条件満足の場合は姿勢変更速度を目標速度とする（ステップＮ２）。姿勢変更角度から、姿勢変更速度で動作させた場合の時間を求め（ステップＮ３）、各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を計算する（ステップＮ４）。
ステップＮ１で姿勢変更速度とすることが選択されていないと判断された場合は、ステップＮ５に進み、作業点移動速度を目標速度とする。作業点移動距離から前記目標速度で動作させた場合の時間を求め（ステップＮ６）、各アクチュエータ１１_１，１１_２，１１_３
，７１の移動速度を計算する（ステップＮ４）。

＜作用、効果＞
以上の実施形態１〜４の作業装置１によると、次の作用、効果が得られる。
制御部４が、各姿勢制御用のアクチュエータ１１_１，１１_２，１１_３の移動速度および前記組み合わせ側のアクチュエータ７１の移動速度を計算するときに用いる目標速度を、作業点移動速度と姿勢変更速度とに切り替える切替え機能部４ａを有するため、エンドエフェクタ６の作業点Ｐが移動せず、エンドエフェクタ６の姿勢のみが変更される場合でも各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を制御できる。
実施形態２のように予め移動距離閾値を規定しておき、作業点Ｐの移動距離が移動距離閾値の範囲内であるときには、作業点移動速度ではなく、姿勢変更速度から各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を求める場合は、エンドエフェクタ６の作業点Ｐの移動が微小で、かつエンドエフェクタ６の姿勢を大きく変更する場合でも、エンドエフェクタ６の姿勢を変更するための速度が過大とならず、作業装置１の全体が急に高速で動くことを防止できる。そのため、作業経験が少ない作業者でも安心して作業装置１を扱うことができる。
さらに、実施形態３のように作業点移動速度から計算した各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度がこれらのアクチュエータ１１_１，１１_２，１１_３，７１の定格速度を超えてしまう場合に、作業点移動速度からではなく、姿勢変更速度から各アクチュエータ１１_１，１１_２，１１_３，７１の移動速度を計算するようにした場合は、作業装置１の全体が急に高速で動くことを防止できるだけでなく、各アクチュエータ１１_１，１１_２，１１_３，７１の破損も防止できる。
また、実施形態４のように作業点移動速度から姿勢変更速度に自動で切り替える方法として、オペレータが任意で切り替えることのできる切替スイッチ５を設けることによって、エンドエフェクタ６の作業点Ｐの移動が移動距離閾値の範囲外であった場合にも姿勢変更速度へ変更可能とすることで、オペレータが任意で作業点移動速度と姿勢変更速度とを切り替えることができるようになり、作業点Ｐが連続的に移動する場合にも、ある区間において姿勢変更速度を一定として動作させることが可能となる。

以下、図８〜図１２と共に他の各実施形態につき、説明する。これらの実施形態において、特に説明した事項の他は、第１の実施形態と同様である。

＜実施形態５＞
図８は第５の実施形態を示す。第１の実施形態では、前記組み合わせ機構７０が１軸の直動アクチュエータで構成された例につき説明したが、図８に示すように、直動型の２つのアクチュエータ７１，７２を直交配置した２軸の組み合わせ機構７０Ａを前記リンク作動装置７と組み合わせてもよい。この構成の作業装置１においても、第１の実施形態と同様に前記制御装置２を構成される。ただし、制御装置２は、組み合わせ機構７０Ａにおける各アクチュエータ７１，７２を取り扱う構成とされる。

エンドエフェクタ６の作業点Ｐの移動が微小で、かつエンドエフェクタ６の姿勢を大きく変更する場合、エンドエフェクタ６の作業点Ｐを連続的に移動する際の所定の作業点移動速度で動作させようとすると、エンドエフェクタ６の姿勢を変更するための速度が過大となってしまい、作業装置１の全体が急に高速で動く恐れがある。しかし、目標速度を作業点移動速度から姿勢変更速度に切り替えて各アクチュエータ１１_１，１１_２，１１_３，７１、７２の移動速度を計算することで、この実施形態においても、作業装置１の全体が急に高速で動くことを防止できる。

＜実施形態６＞
図９はさらに他の実施形態を示す。この実施形態は、リンク作動装置７と組み合わせる組み合わせ機構８０が垂直多関節ロボットである場合の例である。この組み合わせ機構８０は、ベースユニット８１上に上方へ垂直に延びる第１のアーム８２が、垂直軸心回りに回転自在に設置され、第１のアクチュエータ８５により回転させられる。第１のアーム８２の先端に第２のアーム８３が水平軸心回りに回動自在に設置され、第２のアクチュエータ８６により回動させられる。第２のアーム８３の先端に第３のアーム８４が前記水平軸心と平行な水平軸心回りに回動自在に設置され、第３のアクチュエータ８７により回動させられる。第３のアーム８４の先端に前記リンク作動装置７が設置されている。前記第１ないし第３のアクチュエータ８５〜８７が、特許請求の範囲で言う組み合わせ側のアクチュエータである。
制御装置２は、第１の実施形態に係る作業装置１の制御装置２と同様の構成とされる。ただし、制御装置２は、組み合わせ機構８０における各アクチュエータ８５〜８７を取り扱う構成とされる。

この構成の場合も、エンドエフェクタ６の作業点Ｐの移動が微小で、かつエンドエフェクタ６の姿勢を大きく変更する場合、エンドエフェクタ６の作業点Ｐを連続的に移動する際の所定の作業点移動速度で動作させようとすると、エンドエフェクタ６の姿勢を変更するための速度が過大となってしまい、作業装置１の全体が急に高速で動く恐れがある。しかし目標速度を作業点移動速度から姿勢変更速度に切り替えて各アクチュエータ１１_１，１１_２，１１_３，８５〜８７の移動速度を計算することで、作業装置１の全体が急に高速で動くことを防止できる。

＜実施形態７＞
図１０はさらに他の実施形態を示す。この実施形態は、リンク作動装置７と組み合わせる組み合わせ機構９０が水平多関節ロボットである場合の例である。この組み合わせ機構９０は、ベースユニット９１上に上方へ垂直に延びる第１のアーム９２が水平旋回自在に設置されている。第１のアーム９２は上端に水平アーム部９２ａを有していて、その先端に第２のアーム９３が垂直軸心回りに回転自在に設置されている。第２のアーム９３は上端に水平アーム部９３ａを有し、先端に第３のアーム９４が上下移動自在な直動機構として構成されている。第１のアーム９２を旋回駆動するアクチュエータ９５、第２のアーム９３を旋回駆動するアクチュエータ９５、および第３のアーム９４を上下動させる直動アクチュエータ９７が、それぞれリンク作動装置７に対する組み合わせ側のアクチュエータである。

制御装置２は、第１の実施形態に係る作業装置１の制御装置２と同様の構成とされる。ただし、制御装置２は、組み合わせ機構９０における各アクチュエータ９５〜９７を取り扱う構成とされる。

この構成の場合においても、エンドエフェクタ６の作業点Ｐの移動が微小で、かつエンドエフェクタ６の姿勢を大きく変更する場合、エンドエフェクタ６の作業点Ｐを連続的に移動する際の所定の作業点移動速度で動作させようとすると、エンドエフェクタ６の姿勢を変更するための速度が過大となってしまい、作業装置１の全体が急に高速で動く恐れがある。しかし、目標速度を作業点移動速度から姿勢変更速度に切り替えて各アクチュエータ１１_１，１１_２，１１_３，９４〜９６の移動速度を計算することで、各作業装置１の全体が急に高速で動くことを防止できる。

＜実施形態８＞
図１１はさらに他の実施形態を示す。この実施形態は、エンドエフェクタ６としてカメラ６Ａおよびレンズ６Ｂをリンク作動装置７の先端に搭載した外観検査装置に適用した例である。リンク作動装置７は、３つの直動型のアクチュエータ７１〜７３が互いに直交して組み合わされた３次元型の組み合わせ機構７０Ｂにおける第３の直動型のアクチュエータ７３に搭載されている。

この実施形態の場合、エンドエフェクタ６の作業点はレンズ６Ｂの焦点Ｐ_Ｆとなる。ワークＷの外観を連続的に撮影している途中で、検査するポイントが固定であり複数の方向から撮影する場合には、作業点移動速度ではなく姿勢変更速度を用いることで一定の速度での撮影が可能となる。

＜実施形態９＞
図１２はさらに他の実施形態を示す。この実施形態は、作業装置１が、エンドエフェクタとしてエアーノズル６Ｃをリンク作動装置の先端に搭載した洗浄装置である場合を示す。リンク作動装置７と組み合わせる組み合わせ機構７０Ｂは、この例では、図１１と共に前述した直交する第１ないし第３の直動型のアクチュエータ７１，７２，７３で構成されている。
洗浄装置に適用した場合、作業点は洗浄位置Ｐ_Ｗであり、エアーノズル６Ｃのノズル口６Ｃａの軸上の規定の距離だけ離れた点となる。洗浄したいポイントである洗浄位置ＰＷが固定であって複数の方向から洗浄する場合には、作業点移動速度ではなく姿勢変更速度を用いることで一定の速度での洗浄が可能となる。洗浄位置Ｐ_Ｗが移動する場合は、作業点移動速度とすることで効率的に洗浄できる。

＜実施形態１０＞
図１２はさらに他の実施形態を示す。この実施形態は、作業装置１が、エンドエフェクタとして把持機構６Ｍをリンク作動装置７の先端に搭載したマニピュレータとされた例である。把持機構６Ｍは、把持機構本体６Ｍａから一対のチャック爪６Ｍｂ，６Ｍｂが突出し、これらチャック爪６Ｍｂ，６Ｍｂを駆動源（図示せず）の駆動により開閉させる構成である。リンク作動装置７と組み合わせる組み合わせ機構７０Ｂは、この例では、図１１と共に前述した直交する第１ないし第３の直動型のアクチュエータ７１，７２，７３で構成されている。
このようなマニピュレータの場合、作業点は把持機構６Ｍの作用点Ｐ_Ｍとなる。ワークＷを把持した状態で、作用点Ｐ_Ｍを中心にワークＷを回転させる場合には、作業点移動速度ではなく姿勢変更速度を用いることで一定の速度での回転が可能となる。ワークＷを移動させる場合は、作業点移動速度とすることで効率的に移動させることができる。

以上、実施形態に基づいて本発明を実施するための形態を説明したが、ここで開示した実施の形態はすべての点で例示であって制限的なものではない。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味および範囲内でのすべての変更が含まれることが意図される。

１…作業装置
２…制御装置
３…記憶部
４…制御部
４ａ…切替え機能部
５…切替スイッチ
６…エンドエフェクタ
６Ａ…カメラ（エンドエフェクタ）
６Ｂ…レンズエンドエフェクタ）
６Ｃ…エアーノズル（エンドエフェクタ）
６Ｍ…把持機構（エンドエフェクタ）
７…リンク作動装置
１０…パラレルリンク機構
１１，１１_１，１１_２，１１_３…姿勢制御用アクチュエータ
１２…基端側のリンクハブ
１３…先端側のリンクハブ
１４…リンク機構
１５…基端側の端部リンク部材
１６…先端側の端部リンク部材
１７…中央リンク部材
７０，７０Ａ，７０Ｂ…組み合わせ機構
７１，７２，７３…組み合わせ側のアクチュエータ
７６…回転中心
８０，９０…組み合わせ機構
８５〜８７，９５〜９７…組み合わせて側のアクチュエータ
Ｏ…交点
Ｏ１…リンクハブと端部リンク部材の回転対偶の中心軸
Ｏ２…端部リンク部材と中央リンク部材の回転対偶の中心軸
Ｐ_ｉ，Ｐ、Ｑ…作業点
ＱＡ…基端側のリンクハブの中心軸
ＱＢ…先端側のリンクハブの中心軸

Claims (4)

1. 基端側のリンクハブに対し先端側のリンクハブが３組以上のリンク機構を介して姿勢を変更可能に連結され、前記各リンク機構は、それぞれ前記基端側のリンクハブおよび前記先端側のリンクハブに一端が回転可能に連結された基端側および先端側の端部リンク部材と、これら基端側および先端側の端部リンク部材の他端に両端がそれぞれ回転可能に連結された中央リンク部材とを有し、前記３組以上のリンク機構のうち２組以上のリンク機構に、 前記基端側のリンクハブに対する前記先端側のリンクハブの姿勢を変更させる姿勢制御用のアクチュエータが設けられたリンク作動装置と、
   前記先端側のリンクハブに取付けられたエンドエフェクタと、
   前記リンク作動装置と組み合わせられて前記エンドエフェクタの作業点と前記リンク作動装置の基準位置とを相対的に変更する１軸以上の組み合わせ側のアクチュエータと、
   前記姿勢制御用のアクチュエータおよび前記組み合わせ側のアクチュエータを制御する制御装置とを備えたリンク作動装置を用いた作業装置であって、
   前記制御装置は、
   前記エンドエフェクタが作業する作業空間上の各作業点の座標である複数の作業座標を記憶しておく記憶部と、
   この記憶部に記憶された前記作業座標から、前記各アクチュエータの移動量および作業座標間の距離を計算し、さらに所定の目標速度を用いて前記各アクチュエータの移動速度を計算し、計算された前記各アクチュエータの移動量および移動速度で前記各アクチュエータを動作させる制御部とを有し、
   前記記憶部に、前記目標速度として、前記作業座標間を連続的に等速で移動するために設定する所定の作業点移動速度と、前記エンドエフェクタの姿勢を所定の角速度で変更するために設定する姿勢変更速度とを記憶し、
   前記制御部は、前記目標速度を、前記作業点移動速度と前記姿勢変更速度とに切り替える切替え機能部を有する、
   パラレルリンク機構を用いた作業装置。
2. 請求項１に記載のパラレルリンク機構を用いた作業装置において、前記切替え機能部は、前記目標速度を、前記エンドエフェクタの移動距離が移動距離閾値を上回る場合は前記作業点移動速度とし、前記移動距離閾値を下回る場合は前記姿勢変更速度とするパラレルリンク機構を用いた作業装置。
3. 請求項１に記載のパラレルリンク機構を用いた作業装置において、前記切替え機能部は、前記目標速度を、前記作業点移動速度から計算した前記各アクチュエータの移動速度のうちの少なくとも一つが速度閾値を上回ると言う速度条件を満足する場合は前記姿勢変更速度とし、前記速度条件を満足しない場合は前記作業点移動速度とするパラレルリンク機構を用いた作業装置。
4. 請求項１ないし請求項３のいずれか１項に記載のパラレルリンク機構を用いた作業装置において、前記目標速度として前記作業点移動速度と前記姿勢変更速度とをオペレータの操作で任意に切り替え可能とする切替スイッチを有するパラレルリンク機構を用いた作業装置。

Images