JP7140419B2 - 3軸パラレルリニアロボット - Google Patents

3軸パラレルリニアロボット Download PDF

Info

Publication number
JP7140419B2
JP7140419B2 JP2021001874A JP2021001874A JP7140419B2 JP 7140419 B2 JP7140419 B2 JP 7140419B2 JP 2021001874 A JP2021001874 A JP 2021001874A JP 2021001874 A JP2021001874 A JP 2021001874A JP 7140419 B2 JP7140419 B2 JP 7140419B2
Authority
JP
Japan
Prior art keywords
connecting rod
linkage assembly
revolute joint
drivers
linkage
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2021001874A
Other languages
English (en)
Other versions
JP2021154480A (ja
Inventor
兆杰 藍
Original Assignee
ナショナル チェン クン ユニバーシティー
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by ナショナル チェン クン ユニバーシティー filed Critical ナショナル チェン クン ユニバーシティー
Publication of JP2021154480A publication Critical patent/JP2021154480A/ja
Application granted granted Critical
Publication of JP7140419B2 publication Critical patent/JP7140419B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/003Programme-controlled manipulators having parallel kinematics
    • B25J9/0045Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J17/00Joints
    • B25J17/02Wrist joints
    • B25J17/0283Three-dimensional joints
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/003Programme-controlled manipulators having parallel kinematics
    • B25J9/0033Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base
    • B25J9/0036Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base with kinematics chains of the type prismatic-rotary-rotary
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/003Programme-controlled manipulators having parallel kinematics
    • B25J9/0045Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base
    • B25J9/0048Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base with kinematics chains of the type rotary-rotary-rotary
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/12Programme-controlled manipulators characterised by positioning means for manipulator elements electric
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/1607Calculation of inertia, jacobian matrixes and inverses

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Transmission Devices (AREA)

Description

関連出願の相互参照
本特許出願は、2020年3月27日に出願された台湾特許出願第109110614号の利益を主張し、その内容全体は、参照により本明細書に組み込まれる。
本発明は、3軸リニアロボット、より詳細には、他の自動機械分野のロボット及び装置で広く使用することができる、3軸パラレルリニアロボットに関する。
従来の3軸パラレルリニアロボットについては、特許文献1(空間における要素の運動及び位置決めのための装置)、特許文献2(直交座標系パラレルマニピュレータ)、及び特許文献3(構造調整可能な3自由度パラレル機構)において開示されている。前述の3軸パラレルリニアロボットの説明は、以下のとおりである。
一般にデルタロボットと呼ばれる特許文献1の空間における要素の運動及び位置決めのための装置は、エンドエフェクタに共に連結された3つの連結手段を備え、このエンドエフェクタは出力端として使用されている。これら3つの連結手段の各々は、駆動アセンブリによって駆動され、また4本の平行バーと2本の回転ジョイントとによって構成されるため、これによってエンドエフェクタを3軸線形運動(XYZ)で作動させることができる。
特許文献1に開示されているデルタロボットでは、エンドエフェクタを連結するための4本の平行バーと2本の回転ジョイントとで構成された、3つの連結手段の使用を想定しており、三次元空間移動の必要性に基づくと、これら3つの連結手段が長過ぎる状態にある。ある空間では、デルタロボットの全体積がこれら3つの連結手段の全長によって制限されるため、デルタロボットの高さ方向の作動ストロークが短くなり、その結果デルタロボットの適用範囲が制限されることになる。
また、前述のデルタロボットでは、連結手段はそれぞれ4本の平行バーと2本の回転ジョイントとで構成されており、ここでは3つ連結手段の各々における4本の平行バーの全長が長い。X軸方向及びY軸方向に沿った各連結手段の剛性は低く、エンドエフェクタはこれら3つの連結手段によって駆動されることから、エンドエフェクタの移動時に揺動する可能性があり、デルタロボットの安定性に影響を及ぼす。その上、デルタロボットの運動のベクトル解析におけるヤコビ行列は、エンドエフェクタの位置によって著しく変化し得るため、速度と動力伝達との関係性の変動が大きくなり過ぎて、運動制御設計がより困難になる。
特許文献2に開示されている直交座標系パラレルマニピュレータは、並列配置された3本のシャフトにそれぞれ連結された3つの連結手段を備える垂直型パラレルロボットであり、これら3つの連結手段はエンドエフェクタに連結されている。3つの連結手段の各々は、順次直列連結された3本の連結ロッドを有し、これら3本の連結ロッドのうちの1本は、3本のシャフトのうちの1本の上で上下に移動することができる。これら3本の連結ロッドのうち隣り合う2本の連結ロッドは、ピボットによって互いに連結されている。3つの連結手段の遠位端にある連結ロッドはエンドエフェクタに連結されており、これら3つの連結手段を別々に駆動することで、エンドエフェクタを駆動して空間内でこれを移動させることができる。
垂直型パラレルロボットを使用して、デルタロボットと同様のモーション機能をもたらすことができるが、この垂直型パラレルロボットでは、その連結手段におけるより効果的な機構設計が提案されておらず、連結手段の全長は依然として長過ぎるものであり、その上作動ストロークが短く、動作安定性が十分ではないという課題もある。
特許文献3に開示されている構造調整可能な3自由度パラレル機構では、固定台、可動台、及び3つの分岐を想定している。分岐はそれぞれ、調整構成要素、支柱、可動部、回転部、連結ロッド、及び球状部を有する。この調整構成要素は、スライドレール、スライドブロック、嵌合ストリップ、及びねじで構成されている。この調整構成要素のうちスライドレールは固定台上に水平に配置され、スライドブロック下部に形成されたスライド溝と整合している。支柱はスライドブロック上に垂直に配置され、可動部はこの支柱及び回転部に連結され、固定台の上面に垂直な軸を有する。回転部は固定台の上面と平行な軸を有する。連結ロッドは、回転部と球状部との間に連結された端部を有し、球状部によって可動台上に配置されている。
構造調整可能な3自由度パラレル機構を使用して、デルタロボットと同様のモーション機能をもたらすことができるが、この構造調整可能な3自由度パラレル機構では、その連結手段におけるより効果的な機構設計が提案されておらず、可動台と支柱との間で回転部及び球状部に連結された3つの分岐のうちの連結ロッドは、一直線に延在しなければならず、これによって可動台に連結された連結ロッドの長さが長くなり過ぎて、この構造調整可能な3自由度パラレル機構の全高が増大する可能性がある。
その上、可動台と入力駆動端との距離が長く、また構造調整可能な3自由度パラレル機構自体にも、作動ストロークが短く、なおかつ動作安定性が十分ではないという課題がある。
また、別のパラレルロボットが特許文献4(平面パラレル機構制御装置及びダブル5ロッド駆動方式)に開示されている。この平面パラレル機構制御装置は、平面パラレル機構本体と制御部とを備える。この平面パラレル機構本体は、可動台、パッシブ運動用チェーン、及び2つの平面5バー機構を有する。これら2つの平面5バー機構の各々は、2台のダイレクトドライブ回転機、2本の駆動シャフト、及び2本のフォロアシャフトを有する。パッシブ運動用チェーンは、ベアリングアセンブリ及び2本の従動シャフトを有する。制御部は、可動台に配置された3軸加速度センサとダイレクトドライブ回転機とに電気的に連結されている。2つの平面状の5バー機構はアクティブ運動用チェーンとして使用され、またダイレクトドライブ回転機によって作動する。
平面パラレル機構制御装置の平面パラレル機構本体は、可動台を駆動して移動させるように制御され得るが、パッシブ運動は2つの平面状の5バー機構と組み合わされ、また、駆動シャフト及び従動シャフトのピボット軸は、2台のダイレクトドライブ回転機の軸と平行になっている。その場合、この可動台を、水平方向に沿って平面上を移動するように駆動することができるのみとなり、三次元空間内を移動するように駆動することはできないため、このことが、平面パラレル機構制御装置の適用範囲を限定してしまう恐れがある。加えて、平面パラレル機構本体は5本の運動用チェーンを使用する必要があり、この平面パラレル機構本体の全体構造は複雑となっている。
米国特許第4976582号明細書 米国特許6729202号明細書 中国特許第105150199号明細書 中国特許第107139174号明細書
これらの欠点を克服するために、本発明は、前述の課題を軽減する3軸パラレルリニアロボットを提供しようとするものである。
本発明の主な目的は、他の自動機械分野のロボット及び装置で広く使用することができる、3軸パラレルリニアロボットを提供することである。
本発明による3軸パラレルリニアロボットは、中心軸を中心に配置された3つのドライバと、運動機構とを備える。この運動機構は、エンドエフェクタに並列連結された3つのリンク機構アセンブリを有する。エンドエフェクタが三次元空間内を線形移動できるようにするために、これら3つのリンク機構アセンブリはそれぞれ、3つのドライバによって線形駆動又は回転駆動される。リンク機構アセンブリはそれぞれ、3本の連結ロッド及び3本の回転ジョイントを有する。それぞれの回転ジョイントと、中心軸に垂直な仮想平面との間に画定される内角は、鋭角である。第1の回転ジョイントと第2の回転ジョイントとの間の第1の中心距離は、第2の回転ジョイントと第3の回転ジョイントとの間の第2の中心距離に等しい。作動ストロークを増加させ、また本3軸パラレルリニアロボットの動作安定性を向上させるために、運動機構の全高を低減している。
本発明の他の目的、利点及び新規の特徴は、添付の図面と併せて解釈される場合、以下の詳細な説明を参照することによってより明らかになるであろう。
図1は、本発明による3軸パラレルリニアロボットの第1の実施形態を示す斜視図である。 図2は、図1の3軸パラレルリニアロボットの基台の固定フレーム板を取り外した状態を示す斜視図である。 図3は、図1の3軸パラレルリニアロボットの側面図である。 図4は、図1の3軸パラレルリニアロボットの上面図である。 図5は、本発明による3軸パラレルリニアロボットの第2の実施形態を示す斜視図である。 図6は、図5の3軸パラレルリニアロボットの側面図である。 図7は、図5の3軸パラレルリニアロボットの上面図である。 図8は、図5の3軸パラレルリニアロボットの運動機構の動作上面図である。 図9は、図1の3軸パラレルリニアロボットの運動機構のリンク機構アセンブリ及びエンドエフェクタの動作側面図である。 図10は、本発明による3軸パラレルリニアロボットの第3の実施形態を示す斜視図である。 図11は、図10の3軸パラレルリニアロボットの別の斜視図である。 図12は、図10の3軸パラレルリニアロボットの上面図である。 図13は、図10の3軸パラレルリニアロボットの底面図である。 図14は、図10の3軸パラレルリニアロボットの側面図である。 図15は、図10の3軸パラレルリニアロボットの拡大斜視図である。 図16は、図10の3軸パラレルリニアロボットの別の拡大斜視図である。
図1、図5、及び図10を参照すると、本発明による3軸パラレルリニアロボットは3つの実施形態を有し、また3軸パラレルリニアロボットは、作業領域Wと、この作業領域Wの幾何学的中心を通過する中心軸Oと、3つのドライバ1A、1B、1Cと、運動機構2とを備える。
図1、図5、及び図10を参照すると、3つのドライバ1A、1B、1Cは3軸パラレルリニアロボットの中心軸Oを中心に配置され、駆動力を線形入力又は回転入力している。これら3つのドライバの構造及び種類は、本発明の3つの実施形態で提示することができる。
図1、図3、及び図4を参照すると、本発明による3軸パラレルリニアロボットの第1の実施形態では、3つのドライバ1Aの各々は、スピンドル10A、サーボモータ11A、及び変速機アセンブリ12Aを有する。図8及び図9をさらに参照すると、3つのドライバ1Aのスピンドル10Aは中心軸Oに平行であり、また中心軸Oを中心に等角度分布で配置されている。つまり、スピンドル10Aはそれぞれ、中心軸Oに対して距離rp(rp≠0)を有する。サーボモータ11Aはスピンドル10Aの側部に配置され、かつシャフトを有する。変速機アセンブリ12Aは、サーボモータ11Aのシャフト及びスピンドル10Aの端部に連結され、スピンドル10Aを介して運動機構2に連結されている。3つのドライバ1Aは駆動力を線形入力することにより、運動機構2を共に駆動して、これを線形移動させている。変速機アセンブリ12Aは、タイミングプーリ体、ギヤ体又は他の同等の変速機アセンブリから選択することができる。
図1、図3、及び図4を参照すると、本3軸パラレルリニアロボットの第1の実施形態では、本3軸パラレルリニアロボットは基台13Aをさらに備え、そしてこの基台13Aは3つの固定フレーム板131Aを有する。3つのドライバ1Aの各々1つが、基台13Aの3つの固定フレーム板131Aの各々1つの固定フレーム板131A上に配置されている。
図5~図7を参照すると、本発明による3軸パラレルリニアロボットの第2の実施形態では、3つのドライバ1Bが固定フレーム10B上に回転対称に配置されている。中心軸Oは、固定フレーム10Bの幾何学的中心を通過している。3つのドライバ1Bの各々は、サーボモータ11B及び駆動アーム12Bを有する。サーボモータ11Bは固定フレーム10Bにしっかりと取り付けられ、またシャフト111Bを有する。駆動アーム12Bは両端部を有し、これら両端部のうちの一方はサーボモータ11Bのシャフト111Bにしっかりと連結され、そして駆動アーム12Bの両端部のうちの他方は運動機構2に連結されている。3つのドライバ1Bは駆動力を回転入力することにより、運動機構2を共に駆動して、これを線形運動で移動させている。
図10~図16を参照すると、本発明による3軸パラレルリニアロボットの第3の実施形態では、3つのドライバ1Cは、中心軸Oに対して回転対称に固定構造物13C上に配置されている。この固定構造物13Cは単一の構成要素であってもよいし、あるいは3つの固定マウント131Cを有していてもよく、そしてこれら3つのドライバ1Cの各々1つが、3つの固定マウント131Cのそれぞれ1つずつに配置される。
3つのドライバ1Cの各々は、サーボモータ11C、駆動アーム12C、及び補助アーム14Cを有する。サーボモータ11Cは3つの固定マウント131Cのうちの1つに配置され、またシャフト111Cを有する。駆動アーム12Cは両端部を有し、これら両端部のうちの一方はサーボモータ11Cのシャフト111Cにしっかりと連結され、そして駆動アーム12Cの両端部のうちの他方は運動機構2に連結されている。補助アーム14Cは駆動アーム12Cと平行であり、また両端部を有し、これら両端部のうち一方は固定構造物13Cに回転可能に連結され、これら両端部のうちの他方は運動機構2に連結されている。3つのドライバ1Cは駆動力を回転入力することにより、運動機構2を共に駆動して、これを線形運動で移動させており、また、駆動アーム12Cと補助アーム14Cとで構成されたパラレルリンク体は、これら3つのドライバ1Cが共に連動することにより、運動機構2の線形運動の安定性を向上させることができる。
図1~図4、図5~図7、及び図10~図11を参照すると、運動機構2は3つのドライバ1A、1B、1Cによって協働駆動され、またエンドエフェクタ20及び3つのリンク機構アセンブリ30を有する。運動機構20の幾何学的中心Cは、本3軸パラレルリニアロボットの作業領域W内に位置し、また3つのリンク機構アセンブリ30は中心軸Oに対して互いに回転対称であり、なおかつエンドエフェクタ20に並列連結されている。これらリンク機構アセンブリ30の各々は、3つのドライバ1A、1B、1Cのそれぞれ1つによって駆動され、その結果、エンドエフェクタ20は三次元空間内を線形移動するように駆動され得る。
図1~図4、図5~図7、及び図10~図11、さらに図8及び図9を参照すると、運動機構2における3つのリンク機構アセンブリ30の各々は、第1の連結ロッド31、第2の連結ロッド32、及び第3の連結ロッド33を有する。第1の連結ロッド31は両端部を有し、これら両端部のうちの一方は対応するドライバ1A、1B、1Cに連結され、またこれら両端部のうちの他方は、第1の回転ジョイント34によって第2の連結ロッド32の両端部のうちの一方にピボット連結されている。第2の連結ロッド32の両端部のうちの他方は、第2の回転ジョイント35によって第3の連結ロッド33の両端部のうちの一方にピボット連結されている。第3の連結ロッド33の両端部のうちの他方は、第3の回転ジョイント36によってエンドエフェクタ20にピボット連結されている。第1の回転ジョイント34、第2の回転ジョイント35、及び第3の回転ジョイント36は全て、ベアリングなどの単一の回転中心軸の回転部分である。また、第1の回転ジョイント34、第2の回転ジョイント35、及び第3の回転ジョイント36の回転中心軸は互いに平行である。エンドエフェクタ20における幾何学的中心Cの閉運動軌道範囲の交点が生成され、また3つのリンク機構アセンブリ30によって駆動されて、作業領域Wを形成する。
図8及び図9を参照すると、第1の回転ジョイント34と、中心軸Oに垂直な仮想平面Pとの間に画定される内角βは、鋭角である。第1の回転ジョイント34は、中心軸Oを通過するy軸法線に対する距離d1、中心軸Oを通過するx軸法線に対する距離d2、第1の回転ジョイント34と第2の回転ジョイント35との間に画定される第1の中心距離d3、及び第2の回転ジョイント35と第3の回転ジョイント36との間に画定される第2の中心距離d4を有する。第1の中心距離d3は第2の中心距離d4に等しい。
さらに、図9を参照すると、各リンク機構アセンブリ30の第2の連結ロッド32は、リンク機構アセンブリ30の第1の回転ジョイント34に垂直な方向において、第2の連結ロッド32の両端部間に画定される長さL1を有する。各リンク機構アセンブリ30の第3の連結ロッド33は、リンク機構アセンブリ30の第2の回転ジョイント35に垂直な方向において、第3の連結ロッド33の両端部間に画定される長さL2を有する。これら2つの当該長さL1、L2のうちの一方はゼロに等しくてもよく、且つ当該長さL1、L2のうち他方はゼロに等しくなくてもよい。さらに、これら2つの当該長さL1、L2はゼロに等しくなくてもよい。
図1~図4を参照すると、3軸パラレルリニアロボットの第1の実施形態では、ドライバ1Aがそれぞれスピンドル10A、シャフト111Aを有するサーボモータ11A、及び変速機アセンブリ12Aを有する場合、第1の連結ロッド31はそれぞれねじ付きスリーブを有し、また対応するスピンドル10Aは、対応するスピンドル10Aの外面上に形成されたねじ山によって、第1の連結ロッド31のねじ付きスリーブに取り付けられ、かつ螺合する。ドライバ1Aはそれぞれ、応動する第1の連結ロッド31を駆動して、対応するスピンドル10Aに沿って線形移動させることができる。
図5~図7を参照すると、3軸パラレルリニアロボットの第2の実施形態では、3つのドライバ1Bが回転対称に固定フレーム10B上に配置されており、ドライバ1Bはそれぞれ、シャフト111Bを有するサーボモータ11B及び駆動アーム12Bを有する。駆動アーム12Bの両端部のうちの一方はシャフト111Bにしっかりと連結され、また駆動アーム12Bの両端部のうちの他方は応動する第1の連結ロッド31に連結されている。各ドライバ1Bの駆動アーム12Bが振動して、対応する第1の連結ロッド31を駆動することにより、中心軸Oに平行な方向にこれを移動させることができる。
図10~図16を参照すると、3軸パラレルリニアロボットの第3の実施形態では、3つのドライバ1Cが回転対称に固定構造物13C上に配置されている場合、ドライバ1Cはそれぞれ、シャフト111Cを有するサーボモータ11C、駆動アーム12C、及び補助アーム14Cを有する。サーボモータ11Cは、固定構造物13Cの3つの固定マウント131Cのうちの1つにしっかり固定して配置され、駆動アーム12Cの両端部のうちの一方は、応動する第1の連結ロッド31に回転可能に連結され、補助アーム14Cは駆動アーム12Cと平行であり、補助アーム14Cの両端部のうちの一方は、固定構造物13Cにおいて対応する固定マウント131Cに回転可能に連結され、また、補助アーム14Cの両端部のうちの他方は、対応する第1の連結ロッド31に回転可能に連結されている。各ドライバ1Cの駆動アーム12C及び補助アーム14Cは、共に振動するように駆動されて、対応する第1の連結ロッド31が中心軸Oに平行な方向に移動できるようにしている。
3軸パラレルリニアロボットの第3の実施形態では、駆動アーム12Cは、ベアリング121Cによって対応する第1の連結ロッド31に連結され、且つ補助アーム14Cは、ベアリング141Cによって、固定構造物13Cにおいて対応する固定マウント131Cに回転可能に連結され、かつベアリング141Cによって、対応する第1の連結ロッド31に回転可能に連結されている。駆動アーム12Cと補助アーム14Cとによって形成されたパラレルリンク機構アセンブリを使用すると、ベアリング121C、141Cの寸法公差によってベアリング121C、141Cの内側の構成要素間に間隙が生じた場合でも、補助アーム14Cが依然として駆動アーム12Cを補助することができ、このことにより、ドライバ1Cによって駆動される運動機構2の線形運動の安定性を維持することができる。
図3~図4、図6~図7、図10~図11、及び図8~図9を参照すると、本発明による3軸パラレルリニアロボットの運動に関して、3軸パラレルリニアロボットでは、ベクトル制御解析としてヤコビ行列を使用することができ、次いで3つのドライバ1A、1B、及び1Cを制御して、図1に示す第1の実施形態の線形入力で駆動するか、又は図5及び図10に示す第2の並びに第3の実施形態の回転入力で駆動している。次いで、運動機構2の3つのリンク機構アセンブリ30は、エンドエフェクタ20を共に駆動して、三次元空間内でこれを線形移動させることができる。ヤコビ行列は従来技術に属しているため、ここではこれについて繰り返さないものとする。
上記の説明によれば、本発明の3軸パラレルリニアロボットは、少なくとも以下の利点及び効果を有する。
第一に、運動機構の全高を低減し、作動ストロークを増加させている。
本発明の3軸パラレルリニアロボットでは、3つのリンク機構アセンブリ30を含む運動機構2を使用しており、これらリンク機構アセンブリ30はそれぞれ、第1の連結ロッド31、第2の連結ロッド32、第3の連結ロッド33、第1の連結ロッド31及び第2の連結ロッド32に連結された第1の回転ジョイント34、第2の連結ロッド32及び第3の連結ロッド33に連結された第2の回転ジョイント35、並びに第3の連結ロッド33及びエンドエフェクタ20に連結された第3の回転ジョイント36を有する。第1の連結ロッド31、第2の連結ロッド32、及び第3の連結ロッド33は、順次直列連結されている。回転ジョイント34、35、36の各々は、単一の回転中心軸の回転部分であり、また回転ジョイント34、35、36の各々と、中心軸Oに垂直な仮想平面Pとの間に画定される内角は、鋭角である。第1の回転ジョイント34、第2の回転ジョイント35、及び第3の回転ジョイント36の回転中心軸は、互いに平行である。第1の回転ジョイント34と第2の回転ジョイント35との間に画定される第1の中心距離d3は、第2の回転ジョイント35と第3の回転ジョイント36との間に画定される第2の中心距離d4に等しい。上記の特徴及び構造関係によれば、本発明の運動機構2の全体構造を平坦化して、運動機構2の全高を低減し、なおかつ作動ストロークを増加させることができる。エンドエフェクタ20と同じ作業領域Wの条件下で、本発明の3軸パラレルリニアロボットの全高は、従来のデルタロボットの全高の約半分未満であり、なおかつ従来の垂直型パラレルロボットの全高未満であり、このことにより、本発明の3軸パラレルリニアロボットは、省スペースで大規模な作動ストロークを実現することができる。
第二に、速度と動力伝達との関係性が一定である。
本発明の上記の特徴及び構造関係によれば、3軸パラレルリニアロボットでは、ベクトル制御解析としてヤコビ行列を使用しており、3つのドライバ1A、1B、1Cを線形入力型又は回転入力型から選択して、運動機構2を駆動することができ、これにより、ヤコビ行列を特定の定数値(線形入力型)にするか、又はこの特定の定数値に近似させることができる(回転入力型)。その結果、3軸パラレルリニアロボットのエンドエフェクタ20の速度と動力伝達との関係性を一定にすることができ、本発明の3軸パラレルリニアロボットの運動制御設計が容易になる。
第三に、出力速度を上昇させている。
本発明の3軸パラレルリニアロボットの運動機構2を平坦化して、その全高を低くしたために、駆動入力端からエンドエフェクタ20までの距離が比較的短く、また、速度と動力伝達との関係性が一定になっているので、同じ入力速度の条件下では、本発明の3軸パラレルリニアロボットの出力速度はより速く、当該速度は従来のデルタロボットの出力速度の約2倍である。
第四に、運動安定性を向上させている。
本発明の3軸パラレルリニアロボットの運動機構2におけるリンク機構アセンブリ30の連結ロッド31、32、33の数は少なく、また3軸パラレルリニアロボットでは、ピボット構成要素として回転ジョイント34、35、36を使用している。その結果、3軸パラレルリニアロボットの全体的な剛性と耐摩耗性とが向上し、また、本3軸パラレルリニアロボットの構成要素間の間隙が小さくなる。また、本3軸パラレルリニアロボットの運動安定性を効果的に向上させることができるように、運動機構2の平坦化した構造は、本発明の3軸パラレルリニアロボットの全高を低くする。
本発明の多くの特徴及び利点を、本発明の構造及び特徴の詳細と共に前述の説明に記載しているが、本開示は例示にすぎない。特に部品の形状、サイズ、及び配置の点でこれらの詳細に変更を加えることは、添付の特許請求の範囲で表現される用語の広い一般的意味によって示される本発明の原理の全範囲内で可能である。

Claims (9)

  1. 作業領域と、
    該作業領域の幾何学的中心を通過する中心軸と、
    該中心軸を中心に配置された3つのドライバと、
    該3つのドライバによって協働駆動され、また幾何学的中心が前記作業領域内に位置しているエンドエフェクタを有する運動機構と、
    前記中心軸に対して互いに回転対称であり、なおかつ前記エンドエフェクタに並列連結されている3つのリンク機構アセンブリとを備え、
    該リンク機構アセンブリの各々は、前記3つのドライバの各々1つによって駆動され、前記エンドエフェクタは三次元空間内を線形移動するように駆動され、前記リンク機構アセンブリの各々は、
    第1の連結ロッド、
    第2の連結ロッド、及び
    第3の連結ロッド有し、
    ここで、各前記リンク機構アセンブリの前記第1の連結ロッドは両端部を有し、前記連結ロッドの該両端部のうちの一方は前記3つのドライバのうちの1つに連結され、また前記両端部のうちの他方は、第1の回転ジョイントによって前記第2の連結ロッドの両端部のうちの一方にピボット連結されており、前記第2の連結ロッドの前記両端部のうちの他方は、第2の回転ジョイントによって前記第3の連結ロッドの両端部のうちの一方にピボット連結されており、前記第3の連結ロッドの前記両端部のうちの他方は、第3の回転ジョイントによって前記エンドエフェクタにピボット連結されており、前記エンドエフェクタにおける前記幾何学的中心の閉運動軌道範囲の交点が生成され、また前記3つのリンク機構アセンブリによって駆動されて、前記作業領域を形成しており、
    各前記リンク機構アセンブリの前記第1の回転ジョイントと、前記中心軸に垂直な仮想平面Pとの間に画定される内角は、鋭角であり、且つ前記第1の回転ジョイント、前記第2の回転ジョイント、及び前記第3の回転ジョイントの回転中心軸は互いに平行であり、
    各前記リンク機構アセンブリの前記第1の回転ジョイントと前記第2の回転ジョイントとの間に第1の中心距離が画定され、各前記リンク機構アセンブリの前記第2の回転ジョイントと前記第3の回転ジョイントとの間に第2の中心距離が画定され、また、前記第1の中心距離は前記第2の中心距離に等しく、
    前記3つのドライバの各々は、
    スピンドルであって、前記3つのドライバの該スピンドルは前記中心軸に平行であり、また前記中心軸を中心に等角度分布で配置されている、スピンドル、
    シャフトを有するサーボモータ、及び
    該サーボモータの該シャフト及び前記スピンドルの端部に連結された変速機アセンブリを有し、
    各前記リンク機構アセンブリの前記第1の連結ロッドはねじ付きスリーブを有し、
    各前記ドライバの前記スピンドルは、応動する前記リンク機構アセンブリの1つにおける前記第1の連結ロッドの前記ねじ付きスリーブに取り付けられ、かつ螺合しており、また、
    前記ドライバはそれぞれ、応動する前記リンク機構アセンブリにおける前記第1の連結ロッドを駆動して、対応する前記スピンドルに沿ってこれを線形移動させている、
    3軸パラレルリニアロボット。
  2. 各前記ドライバの前記変速機アセンブリは、タイミングプーリ体である、請求項に記載の3軸パラレルリニアロボット。
  3. 前記3軸パラレルリニアロボットは基台を備え、
    該基台は3つの固定フレーム板を有し、
    前記3つのドライバの各々1つが、前記基台の前記3つの固定フレーム板の各々1つの上に配置されている
    請求項に記載の3軸パラレルリニアロボット。
  4. 作業領域と、
    該作業領域の幾何学的中心を通過する中心軸と、
    該中心軸を中心に配置された3つのドライバと、
    該3つのドライバによって協働駆動され、また幾何学的中心が前記作業領域内に位置しているエンドエフェクタを有する運動機構と、
    前記中心軸に対して互いに回転対称であり、なおかつ前記エンドエフェクタに並列連結されている3つのリンク機構アセンブリとを備え、
    該リンク機構アセンブリの各々は、前記3つのドライバの各々1つによって駆動され、前記エンドエフェクタは三次元空間内を線形移動するように駆動され、前記リンク機構アセンブリの各々は、
    第1の連結ロッド、
    第2の連結ロッド、及び
    第3の連結ロッド有し、
    ここで、各前記リンク機構アセンブリの前記第1の連結ロッドは両端部を有し、前記連結ロッドの該両端部のうちの一方は前記3つのドライバのうちの1つに連結され、また前記両端部のうちの他方は、第1の回転ジョイントによって前記第2の連結ロッドの両端部のうちの一方にピボット連結されており、前記第2の連結ロッドの前記両端部のうちの他方は、第2の回転ジョイントによって前記第3の連結ロッドの両端部のうちの一方にピボット連結されており、前記第3の連結ロッドの前記両端部のうちの他方は、第3の回転ジョイントによって前記エンドエフェクタにピボット連結されており、前記エンドエフェクタにおける前記幾何学的中心の閉運動軌道範囲の交点が生成され、また前記3つのリンク機構アセンブリによって駆動されて、前記作業領域を形成しており、
    各前記リンク機構アセンブリの前記第1の回転ジョイントと、前記中心軸に垂直な仮想平面Pとの間に画定される内角は、鋭角であり、且つ前記第1の回転ジョイント、前記第2の回転ジョイント、及び前記第3の回転ジョイントの回転中心軸は互いに平行であり、
    各前記リンク機構アセンブリの前記第1の回転ジョイントと前記第2の回転ジョイントとの間に第1の中心距離が画定され、各前記リンク機構アセンブリの前記第2の回転ジョイントと前記第3の回転ジョイントとの間に第2の中心距離が画定され、また、前記第1の中心距離は前記第2の中心距離に等しく、
    前記3つのドライバは固定フレーム上に回転対称に配置されており、
    前記中心軸は、前記固定フレームの幾何学的中心を通過しており、
    前記3つのドライバの各々は、
    前記固定フレームにしっかりと取り付けられ、またシャフトを有するサーボモータ、及び、
    両端部を有する駆動アームであって、該両端部のうちの一方は前記サーボモータの前記シャフトにしっかりと連結され、そして前記駆動アームの前記両端部のうちの他方は、応動する前記リンク機構アセンブリの1つの前記第1の連結ロッドに連結されている、駆動アームを有し、また、
    各前記ドライバの前記駆動アームが振動して、対応する前記第1の連結ロッドを駆動することにより、前記中心軸に平行な方向に前記第1の連結ロッドを移動させている
    3軸パラレルリニアロボット。
  5. 前記3つのドライバは、前記中心軸に対して回転対称に固定構造物上に配置されており、
    前記3つのドライバの各々は、
    前記固定構造物にしっかり固定して配置され、かつスピンドルを有するサーボモータ、
    両端部を有する駆動アームであって、該両端部のうちの一方は前記サーボモータの前記スピンドルにしっかりと連結され、且つ前記駆動アームの前記両端部のうちの他方は、応動する前記リンク機構アセンブリの前記第1の連結ロッドに回転可能に連結されている、駆動アーム、及び
    前記駆動アームと平行であり、両端部を有する補助アームであって、該補助アームの前記両端部のうちの一方は、前記固定構造物に回転可能に連結され、また、前記補助アームの前記両端部のうちの他方は、応動する前記リンク機構アセンブリにおける前記第1の連結ロッドに回転可能に連結されている、補助アームを有し、
    ここで、各前記ドライバの前記駆動アーム及び該補助アームは、共に振動するように駆動されて、応動する前記リンク機構アセンブリにおける前記第1の連結ロッドが前記中心軸に平行な方向に移動できるようにしている、
    請求項1からのいずれか一項に記載の3軸パラレルリニアロボット。
  6. 各前記リンク機構アセンブリの前記第2の連結ロッドは、前記リンク機構アセンブリの前記第1の回転ジョイントに垂直な方向において、前記第2の連結ロッドの前記両端部間に画定される長さを有し、
    各前記リンク機構アセンブリの前記第3の連結ロッドは、前記リンク機構アセンブリの前記第2の回転ジョイントに垂直な方向において、前記第3の連結ロッドの前記両端部間に画定される長さを有し、また、
    該2つの前記長さのうちの一方はゼロに等しく、また他方の前記長さはゼロに等しくはない、
    請求項1からのいずれか一項に記載の3軸パラレルリニアロボット。
  7. 各前記リンク機構アセンブリの前記第2の連結ロッドは、前記リンク機構アセンブリの前記第1の回転ジョイントに垂直な方向において、前記第2の連結ロッドの前記両端部間に画定される長さを有し、
    各前記リンク機構アセンブリの前記第3の連結ロッドは、前記リンク機構アセンブリの前記第2の回転ジョイントに垂直な方向において、前記第3の連結ロッドの前記両端部間に画定される長さを有し、また、
    該2つの前記長さはゼロに等しくはない、
    請求項1からのいずれか一項に記載の3軸パラレルリニアロボット。
  8. 各前記リンク機構アセンブリの前記第2の連結ロッドは、前記リンク機構アセンブリの前記第1の回転ジョイントに垂直な方向において、前記第2の連結ロッドの前記両端部間に画定される長さを有し、
    各前記リンク機構アセンブリの前記第3の連結ロッドは、前記リンク機構アセンブリの前記第2の回転ジョイントに垂直な方向において、前記第3の連結ロッドの前記両端部間に画定される長さを有し、また、
    該2つの前記長さのうちの一方はゼロに等しく、また他方の前記長さはゼロに等しくはない、
    請求項に記載の3軸パラレルリニアロボット。
  9. 各前記リンク機構アセンブリの前記第2の連結ロッドは、前記リンク機構アセンブリの前記第1の回転ジョイントに垂直な方向において、前記第2の連結ロッドの前記両端部間に画定される長さを有し、
    各前記リンク機構アセンブリの前記第3の連結ロッドは、前記リンク機構アセンブリの前記第2の回転ジョイントに垂直な方向において、前記第3の連結ロッドの前記両端部間に画定される長さを有し、また、
    該2つの前記長さはゼロに等しくはない、
    請求項に記載の3軸パラレルリニアロボット。
JP2021001874A 2020-03-27 2021-01-08 3軸パラレルリニアロボット Active JP7140419B2 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
TW109110614 2020-03-27
TW109110614 2020-03-27

Publications (2)

Publication Number Publication Date
JP2021154480A JP2021154480A (ja) 2021-10-07
JP7140419B2 true JP7140419B2 (ja) 2022-09-21

Family

ID=77808484

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021001874A Active JP7140419B2 (ja) 2020-03-27 2021-01-08 3軸パラレルリニアロボット

Country Status (4)

Country Link
US (1) US11745365B2 (ja)
JP (1) JP7140419B2 (ja)
CN (1) CN113442112B (ja)
TW (1) TWI757959B (ja)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115741735A (zh) * 2022-11-23 2023-03-07 合肥工业大学 一种多维度刚柔耦合智能机器人及其控制方法
CN118080994A (zh) * 2024-04-23 2024-05-28 顺达模具科技有限公司 一种汽车变速箱齿轮加工成型装置

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030121351A1 (en) 2001-05-31 2003-07-03 Clement Gosselin Cartesian parallel manipulators
CN105150199A (zh) 2015-10-27 2015-12-16 河南理工大学 结构可调的三自由度并联机构
CN107139174A (zh) 2017-06-28 2017-09-08 华南理工大学 双五杆机构驱动的平面并联机构控制装置及方法

Family Cites Families (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2029996C3 (de) * 1970-06-18 1973-11-08 J.M. Voith Gmbh, 7920 Heidenheim Steuervorrichtung eines Flügel radpropellers
CH672089A5 (ja) 1985-12-16 1989-10-31 Sogeva Sa
US5699695A (en) * 1996-05-01 1997-12-23 Virginia Tech Intellectual Properties, Inc. Spatial, parallel-architecture robotic carpal wrist
JP2005144627A (ja) * 2003-11-18 2005-06-09 Ntn Corp リンク作動装置
WO2006102393A2 (en) * 2005-03-22 2006-09-28 Ross-Hime Designs, Incorporated Robotic manipulator
JP5951224B2 (ja) * 2011-11-02 2016-07-13 Ntn株式会社 リンク作動装置の原点位置初期設定方法およびリンク作動装置
EP2979823B1 (en) * 2013-03-26 2019-07-10 NTN Corporation Linking apparatus control device
KR101401463B1 (ko) * 2013-05-16 2014-05-30 주식회사 엔티리서치 와이어로프를 이용하여 추가 자유도를 부여한 병렬 링크 로봇
JP6289973B2 (ja) * 2014-03-31 2018-03-07 Ntn株式会社 パラレルリンク機構およびリンク作動装置
CN104950797B (zh) * 2015-04-30 2018-05-01 中国矿业大学 一种3-prrs六自由度并联定位平台
JP6067805B1 (ja) * 2015-09-07 2017-01-25 Ntn株式会社 リンク作動装置を用いた複合作業装置
JP2018001385A (ja) * 2016-07-08 2018-01-11 ソニー株式会社 パラレルリンク装置、産業用ロボット、及び力覚提示装置
CN106272363A (zh) * 2016-09-30 2017-01-04 华南理工大学 摆动气缸驱动的三自由度柔性并联机构控制装置及方法
JP6688470B2 (ja) * 2018-03-12 2020-04-28 株式会社安川電機 パラレルリンクロボット及びパラレルリンクロボットシステム
US11668375B2 (en) * 2018-10-10 2023-06-06 Kyushu Institute Of Technology Parallel link mechanism and link actuation device
CN109514532A (zh) * 2018-12-22 2019-03-26 北京工业大学 含弧形移动副的2r1t对称并联机构
JP7527020B2 (ja) * 2019-03-06 2024-08-02 ユニヴェルシテ ラヴァル 運動学的に冗長な作動を伴うパラレルメカニズム

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030121351A1 (en) 2001-05-31 2003-07-03 Clement Gosselin Cartesian parallel manipulators
CN105150199A (zh) 2015-10-27 2015-12-16 河南理工大学 结构可调的三自由度并联机构
CN107139174A (zh) 2017-06-28 2017-09-08 华南理工大学 双五杆机构驱动的平面并联机构控制装置及方法

Also Published As

Publication number Publication date
US20210299890A1 (en) 2021-09-30
TWI757959B (zh) 2022-03-11
JP2021154480A (ja) 2021-10-07
TW202136003A (zh) 2021-10-01
CN113442112B (zh) 2024-08-06
CN113442112A (zh) 2021-09-28
US11745365B2 (en) 2023-09-05

Similar Documents

Publication Publication Date Title
EP1755838B1 (en) Parallel kinematic robot and method for controlling this robot
US6516681B1 (en) Four-degree-of-freedom parallel robot
CN100393484C (zh) 三平移一转动并联机构
JP7140419B2 (ja) 3軸パラレルリニアロボット
CN104526685B (zh) 含平行四边形支链的冗余驱动平面二自由度并联机械手
WO2019011020A1 (zh) 具有平面两移动自由度的并联机构
JP4289506B2 (ja) 四自由度パラレルロボット
CN108818502B (zh) 具有球面转动自由度的两移动一转动的并联机构
CN203210372U (zh) 一种并联机器人
CN114227648B (zh) 一种高刚度五自由度并联驱动机器人
CN106671066A (zh) 一种立式可重构多功能并联机构
CN111300380B (zh) 一种基于冗余驱动的六自由度并联机器人
CN108908292B (zh) 一种可实现两转三移的混联解耦机床
CN103386681A (zh) 可实现三维平动三维转动的并联机构
CN103231362A (zh) 一种并联机器人
CN109079761B (zh) 一种含闭环支链的两转一移的并联机器人
KR20170120133A (ko) 산업용 로봇
CN202539952U (zh) 具有两条垂直相交转轴的三自由度并联机构
CN113829332B (zh) 一种具有三移动和一转动的四自度并联机器人机构
CN103231371A (zh) 并联机器人及其平行四边形杆组
CN113459071A (zh) 一种三自由度并联机器人
CN106903672A (zh) 二分支三自由度工业机器人
CN203210376U (zh) 并联机器人及其平行四边形杆组
Budde et al. Workspace enlargement of a triglide robot by changing working and assembly mode
CN106695766B (zh) 一种基于抓取并联机构的六自由度并联装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210108

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220125

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220222

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220510

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20220816

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220901

R150 Certificate of patent or registration of utility model

Ref document number: 7140419

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150