JP7462437B2 - ロボットシステム、パラレルリンク機構、制御方法、制御装置、プログラム、及び記憶媒体 - Google Patents
ロボットシステム、パラレルリンク機構、制御方法、制御装置、プログラム、及び記憶媒体 Download PDFInfo
- Publication number
- JP7462437B2 JP7462437B2 JP2020040214A JP2020040214A JP7462437B2 JP 7462437 B2 JP7462437 B2 JP 7462437B2 JP 2020040214 A JP2020040214 A JP 2020040214A JP 2020040214 A JP2020040214 A JP 2020040214A JP 7462437 B2 JP7462437 B2 JP 7462437B2
- Authority
- JP
- Japan
- Prior art keywords
- attitude
- arm mechanism
- control point
- control device
- parallel link
- 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
Links
- 230000007246 mechanism Effects 0.000 title claims description 214
- 238000000034 method Methods 0.000 title claims description 40
- PWPJGUXAGUPAHP-UHFFFAOYSA-N lufenuron Chemical compound C1=C(Cl)C(OC(F)(F)C(C(F)(F)F)F)=CC(Cl)=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F PWPJGUXAGUPAHP-UHFFFAOYSA-N 0.000 title 1
- 239000012636 effector Substances 0.000 claims description 58
- 238000001514 detection method Methods 0.000 claims description 39
- 238000006073 displacement reaction Methods 0.000 claims description 34
- 238000007689 inspection Methods 0.000 claims description 33
- 238000012937 correction Methods 0.000 claims description 21
- 238000003860 storage Methods 0.000 claims description 15
- 230000000149 penetrating effect Effects 0.000 claims 2
- 230000036544 posture Effects 0.000 description 37
- 238000010586 diagram Methods 0.000 description 13
- 239000002184 metal Substances 0.000 description 9
- 238000012545 processing Methods 0.000 description 7
- 238000004891 communication Methods 0.000 description 6
- 239000011248 coating agent Substances 0.000 description 3
- 238000000576 coating method Methods 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 238000003466 welding Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000010422 painting Methods 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 238000005520 cutting process Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 239000007788 liquid Substances 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/003—Programme-controlled manipulators having parallel kinematics
- B25J9/0045—Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base
- B25J9/0051—Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base with kinematics chains of the type rotary-universal-universal or rotary-spherical-spherical, e.g. Delta type manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K31/00—Processes relevant to this subclass, specially adapted for particular articles or purposes, but not covered by only one of the preceding main groups
- B23K31/12—Processes relevant to this subclass, specially adapted for particular articles or purposes, but not covered by only one of the preceding main groups relating to investigating the properties, e.g. the weldability, of materials
- B23K31/125—Weld quality monitoring
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
- B25J17/02—Wrist joints
- B25J17/0208—Compliance devices
- B25J17/0216—Compliance devices comprising a stewart mechanism
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
- B25J17/02—Wrist joints
- B25J17/0258—Two-dimensional joints
- B25J17/0266—Two-dimensional joints comprising more than two actuating or connecting rods
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/1623—Parallel manipulator, Stewart platform, links are attached to a common base and to a common platform, plate which is moved parallel to the base
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39391—Visual servoing, track end effector with camera image feedback
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39552—Stewart platform hand, parallel structured hand
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40524—Replace link, joint, structure by stewart platform to model flexibility
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Quality & Reliability (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
Description
本発明の別の一実施形態は、ロボットシステムに好適に用いられるパラレルリンク機構を提供する。
図面は模式的または概念的なものであり、各部分の厚みと幅との関係、部分間の大きさの比率などは、必ずしも現実のものと同一とは限らない。同じ部分を表す場合であっても、図面により互いの寸法や比率が異なって表される場合もある。本願明細書と各図において、既に説明したものと同様の要素には同一の符号を付して詳細な説明は適宜省略する。
実施形態に係るロボットシステム1は、図1に表したように、アーム機構100、パラレルリンク機構200、エンドエフェクタ300、検出器400、及び制御装置500を含む。
同様に、パラレルリンク機構200は、4自由度以上であることが好ましい。例えば、パラレルリンク機構200は、6自由度を有する。すなわち、パラレルリンク機構200は、可動部220の3方向のそれぞれの位置と、可動部220の3方向まわりのそれぞれの角度と、を制御できる。
実際の作業対象の位置及び向きが予め設計された値からずれている場合、位置及び姿勢のずれ量が検出器400により検出される。制御装置500は、そのずれ量が補正されるように、逆運動学計算によって各アクチュエータ240の回転軸の回転角度を計算する。制御装置500は、各アクチュエータ240の回転角度を計算された値に設定する。これにより、制御点の姿勢が、実際の作業対象の位置及び向きに対応して設定される。
図2を参照して、実施形態に係るロボットシステム1に好適なパラレルリンク機構200の一例について説明する。図2に表したパラレルリンク機構200は、固定部210、可動部220、リンク230、アクチュエータ240、第1ジョイント部材250、第2ジョイント部材260、及び回動アーム270を含む。
パラレルリンク機構200は、アーム機構100及びエンドエフェクタ300のみを含むロボットシステムに、取り付けることもできる。この場合、エンドエフェクタ300をアーム機構100から取り外した後、エンドエフェクタ300に接続されていた配線を孔211及び221に通してパラレルリンク機構200の先端側に引き出すことで、容易にアーム機構100の先端部にパラレルリンク機構200及びエンドエフェクタ300を取り付けることができる。
図3(a)~図3(c)に表した例では、ロボットシステム1は、作業対象Oに対して、エンドエフェクタ300を用いて所定の作業を実行する。
制御装置500がアーム機構100を動かす際には、例えば、制御点に対する移動指令から、逆運動学計算によってアーム機構100の各回転軸120の回転角度又は回転速度が決定される。一方で、アーム機構100には、制御上の特異点が存在する。制御上の特異点とは、逆運動学計算によって各回転軸120の回転角度を決定できない姿勢(位置及び向き)を指す。特異点では、各回転軸120の回転角度を一意に決めることができない。このため、アーム機構100の姿勢を、そのような姿勢に設定することができない。また、特異点付近では、アーム機構100の動作が不安定となりうる。以下では、特異点と、特異点付近の姿勢と、をまとめて「特異点近傍」と呼ぶ。
図4(a)は、アーム機構100を側方から見たときの様子を表す。図4(b)は、アーム機構100を上方から見たときの様子を表す。複数の回転軸120は、基台130からパラレルリンク機構200に向けて、回転軸121~126を含む。図4(a)に表したように、回転軸124の回転中心と回転軸126の回転中心とが同一直線上に並んだ場合、パラレルリンク機構200の回転は、回転軸124及び126のいずれの回転によっても可能である。図4(b)に表したように、回転軸121の回転中心と回転軸126の回転中心とが同一直線上に並んだ場合も、パラレルリンク機構200の回転は、回転軸124及び126のいずれの回転によっても可能である。図4(a)及び図4(b)に表した姿勢に対しては、逆運動学計算によって回転軸121~126のそれぞれの回転角度が一意に決まらない。このため、制御点の姿勢が特異点近傍にあると、アーム機構100が制御不能になる可能性がある。
これらの作業中にアーム機構100の先端部の姿勢が特異点近傍となると、正常に作業を完了させることが困難となる。従って、実施形態に係るロボットシステム1は、特に、作業中において、検出器400による検出結果に基づいてエンドエフェクタ300の姿勢を調整する必要がある場合に、好適に用いられる。
図5(a)~図5(c)は、実施形態に係るロボットシステムの動作の一例を表す模式図である。
図5(a)は、制御装置500により第1動作が実行された後の状態を表している。このとき、制御点の姿勢は、予めプログラムされた第1姿勢に設定される。
図6(a)は、図5(a)と同様に、制御点の姿勢が第1姿勢に設定された状態を表している。この後、制御装置500は、図6(b)に表したように、第1姿勢から作業姿勢への変位量に拘わらず、検出器400による検出結果に基づき、アーム機構100を動かして制御点の姿勢を補正しても良い。
図8は、図5(a)~図5(c)に表した動作を示す。まず、制御装置500は、第1動作(第1ステップ)を実行する(ステップS1)。第1動作では、アーム機構100が動作し、制御点の姿勢が所定の第1姿勢に設定される。制御装置500は、計算処理(計算ステップ)を実行する(ステップS2)。計算処理では、検出器400の検出結果に基づき、作業姿勢までの制御点の姿勢の変位量が計算される。制御装置500は、判定処理(判定ステップ)を実行する(ステップS3)。判定処理では、変位量が、可動部220の可動範囲内であるか判定される。
図10を参照して、実施形態に係るロボットシステム1に用いられるエンドエフェクタ300の一例について説明する。図10に表した例では、エンドエフェクタ300として、検査器310及び塗布装置320が設けられている。この例では、作業対象Oは溶接された部材であり、作業として検査が実行される。また、制御点は、検査器310の先端に設定される。
検査器310先端の内部には、図11に表したマトリクスセンサ311が設けられている。マトリクスセンサ311は、複数の超音波センサ312を含む。超音波センサ312は、例えば、トランスデューサである。複数の超音波センサ312は、互いに交差する2方向(X方向及びY方向)に沿って配列されている。この例では、X方向とY方向は、直交している。なお、複数の超音波センサ312が配列されるX方向及びY方向は、制御点の位置を示す座標系のX方向及びY方向と対応していても良いし、対応していなくても良い。
図12(a)に表したように、超音波USの一部は、金属板51の上面5aまたは溶接部53の上面5bで反射される。超音波USの別の一部は、部材5に入射し、金属板51の下面5cまたは溶接部53の下面5dで反射する。
まず、制御装置500は、第1動作を実行する(ステップS1)。検出器400は、部材5を撮影し、取得した画像から溶接部53の位置を検出する(ステップS11)。制御装置500は、第2動作を実行する(ステップS4)。これにより、検査器310及び塗布装置320の姿勢が調整される。ステップS11とS4との間に、図8又は図9に表した計算処理、判定処理、及び補正動作が実行されても良い。
図14は、検査における傾きの計算方法を説明するための図である。
図15及び図16は、検査において得られた画像の一例である。
(構成1)
多関節のアーム機構と、
前記アーム機構の先端部に取り付けられる固定部、及び、
複数の並列なリンクを介して前記固定部に取り付けられ、前記固定部に対して可動な可動部、
を含むパラレルリンク機構と、
前記可動部に取り付けられ、作業対象への作業を実行するエンドエフェクタと、
前記可動部と前記作業対象との間の位置の関係又は向きの関係を検出するための検出器と、
前記アーム機構及び前記パラレルリンク機構を制御する制御装置と、
を備え、
前記制御装置は、前記エンドエフェクタによる作業時には、前記検出器による検出結果に基づき、前記パラレルリンク機構を動かして前記エンドエフェクタの姿勢を調整する、ロボットシステム。
Claims (21)
- 多関節のアーム機構と、
前記アーム機構の先端部に取り付けられる固定部、及び、
複数の並列なリンクを介して前記固定部に取り付けられ、前記固定部に対して可動な可動部、
を含み、前記アーム機構に対して4以上の自由度を有するパラレルリンク機構と、
前記可動部に取り付けられ、超音波センサを含む検査器を有するエンドエフェクタと、
制御点の位置又は向きを検出する検出器と、
前記アーム機構及び前記パラレルリンク機構を制御する制御装置であって、
前記アーム機構を動かし、前記制御点の姿勢を所定の第1姿勢に設定する第1動作と、
前記第1動作の後に、前記検出器の検出結果に基づいて前記パラレルリンク機構を動かし、前記制御点の前記姿勢を前記エンドエフェクタが作業を実行する作業姿勢に設定する第2動作と、
を実行する、前記制御装置と、
を備え、
前記制御装置は、前記第2動作の後に、
前記超音波センサが作業対象へ超音波を送信したときの反射波の受信結果から、前記作業対象に対する前記検査器の傾きを計算し、
前記傾きが小さくなるように、前記パラレルリンク機構を動作させる、
ロボットシステム。 - 前記制御装置は、前記第1動作と前記第2動作との間に、
前記検出器の検出結果に基づき、前記作業姿勢までの前記制御点の前記姿勢の変位量を計算する計算処理と、
前記変位量が前記可動部の可動範囲内であるか判定する判定処理と、
を実行し、
前記制御装置は、前記判定処理において、前記変位量が前記可動範囲を超えるときには、前記アーム機構を動かして前記制御点の前記姿勢を前記作業姿勢に近づけた後に、前記第2動作を実行する、請求項1記載のロボットシステム。 - 前記制御装置は、
前記第1動作と前記第2動作の間に、前記検出器の検出結果に基づいて前記アーム機構を動かし、前記制御点の前記姿勢を補正姿勢に設定する補正動作を実行し、
前記補正動作において、前記アーム機構の先端部の前記姿勢が特異点近傍を外れるように前記補正姿勢を設定する、
請求項1記載のロボットシステム。 - 前記作業対象は、複数の部材と、前記部材同士が接合された溶接部と、を含み、
前記制御装置は、前記溶接部に対する前記検査器の前記傾きを計算する、請求項1~3のいずれか1つに記載のロボットシステム。 - 前記超音波センサは、第1配列方向と、前記第1配列方向に交差する第2配列方向と、に沿って複数配列され、
前記パラレルリンク機構は、前記アーム機構に対して6自由度を有し、
前記制御装置は、前記第1配列方向と、前記第2配列方向と、前記第1配列方向及び前記第2配列方向を含む面と交差する交差方向と、における前記反射波の強度の勾配を計算し、前記勾配を用いて前記傾きを計算する、請求項4に記載のロボットシステム。 - 前記パラレルリンク機構は、
前記固定部に取り付けられ、回転軸が前記固定部から前記可動部に向かう第1方向と交差する方向に沿って設けられるアクチュエータと、
前記回転軸と連結される第1部分を有し、前記アクチュエータによって回動される回動アームと、
前記回動アームの第2部分と第1ジョイント部材を介して連結され、前記可動部と第2ジョイント部材を介して連結されたリンクと、
をさらに含み、
前記回動アームの前記第1部分と前記第2部分との間には、屈曲部が設けられ、
前記第2部分は、前記第1部分に対して前記可動部側に設けられる、請求項1~5のいずれか1つに記載のロボットシステム。 - 前記固定部は、前記アクチュエータが取り付けられる第1面を有し、
前記可動部は、
前記エンドエフェクタが取り付けられる第2面と、
前記第1方向に対して傾斜し、前記第1方向を向いた第3面と、
を有し、
前記第2面のサイズは、前記第1面のサイズよりも小さく、
前記第2ジョイント部材は、前記第3面に取り付けられる請求項6記載のロボットシステム。 - 前記固定部には、前記第1方向に沿って前記固定部を貫通する第1孔が設けられ、
前記可動部には、前記第1方向に沿って前記可動部を貫通する第2孔が設けられた請求項6又は7に記載のロボットシステム。 - 多関節のアーム機構と、
前記アーム機構の先端部に取り付けられる固定部、及び、
複数の並列なリンクを介して前記固定部に取り付けられ、前記固定部に対して可動な可動部、
を含み、前記アーム機構に対して4以上の自由度を有するパラレルリンク機構と、
前記可動部に取り付けられ、超音波センサを含む検査器を有するエンドエフェクタと、
制御点の位置又は向きを検出する検出器と、
を含むロボットシステムの制御方法であって、
前記アーム機構を動かし、前記制御点の姿勢を所定の第1姿勢に設定する第1ステップと、
前記第1ステップの後に、前記検出器の検出結果に基づいて前記パラレルリンク機構を動かし、前記制御点の前記姿勢を前記エンドエフェクタが作業を実行する作業姿勢に設定する第2ステップと、
を備え、
前記第2ステップの後に、前記超音波センサが作業対象へ超音波を送信したときの反射波の受信結果から、前記作業対象に対する前記検査器の傾きを計算し、前記傾きが小さくなるように、前記パラレルリンク機構を動作させる、制御方法。 - 前記検出器の検出結果に基づき、前記作業姿勢までの前記制御点の前記姿勢の変位量を計算する計算ステップと、
前記変位量が前記可動部の可動範囲内であるか判定する判定ステップと、
をさらに備え、
前記計算ステップ及び前記判定ステップは、前記第1ステップと前記第2ステップとの間に実行され、
前記判定ステップにおいて、前記変位量が前記可動範囲を超えるときには、前記アーム機構を動かして前記制御点の前記姿勢を前記作業姿勢に近づけた後に、前記第2ステップを実行する、請求項9記載の制御方法。 - 前記検出器の検出結果に基づいて前記アーム機構を動かし、前記制御点の前記姿勢を補正姿勢に設定する補正ステップをさらに備え、
前記補正ステップは、前記第1ステップと前記第2ステップとの間に実行され、
前記補正ステップにおいて、前記アーム機構の先端部の前記姿勢が特異点近傍を外れるように前記補正姿勢を設定する、請求項9記載の制御方法。 - 前記エンドエフェクタによる作業の実行中は、前記検出器の検出結果に基づいて前記パラレルリンク機構を動かし、前記制御点の前記姿勢を調整する請求項9~11のいずれか1つに記載の制御方法。
- 多関節のアーム機構と、
前記アーム機構の先端部に取り付けられる固定部、及び、
複数の並列なリンクを介して前記固定部に取り付けられ、前記固定部に対して可動な可動部、
を含み、前記アーム機構に対して4以上の自由度を有するパラレルリンク機構と、
前記可動部に取り付けられ、超音波センサを含む検査器を有するエンドエフェクタと、
制御点の位置又は向きを検出する検出器と、
を含むロボットシステムを制御する制御装置であって、
前記アーム機構を動かし、前記制御点の姿勢を所定の第1姿勢に設定する第1動作と、
前記第1動作の後に、前記検出器の検出結果に基づいて前記パラレルリンク機構を動かし、前記制御点の前記姿勢を前記エンドエフェクタが作業を実行する作業姿勢に設定する第2動作と、
を実行し、
前記第2動作の後に、前記超音波センサが作業対象へ超音波を送信したときの反射波の受信結果から、前記作業対象に対する前記検査器の傾きを計算し、前記傾きが小さくなるように前記パラレルリンク機構を動作させる、制御装置。 - 前記第1動作と前記第2動作との間に、
前記検出器の検出結果に基づき、前記作業姿勢までの前記制御点の前記姿勢の変位量を計算する計算処理と、
前記変位量が前記可動部の可動範囲内であるか判定する判定処理と、
をさらに実行し、
前記判定処理において、前記変位量が前記可動範囲を超えるときには、前記アーム機構を動かして前記制御点の前記姿勢を前記作業姿勢に近づけた後に、前記第2動作を実行する、請求項13記載の制御装置。 - 前記第1動作と前記第2動作の間に、前記検出器の検出結果に基づいて前記アーム機構を動かし、前記制御点の前記姿勢を補正姿勢に設定する補正動作を実行し、
前記補正動作において、前記アーム機構の先端部の前記姿勢が特異点近傍を外れるように前記補正姿勢を設定する、請求項13記載の制御装置。 - 前記エンドエフェクタによる作業の実行中は、前記検出器の検出結果に基づいて前記パラレルリンク機構を動かし、前記制御点の前記姿勢を調整する請求項13~15のいずれか1つに記載の制御装置。
- 多関節のアーム機構と、
前記アーム機構の先端部に取り付けられる固定部、及び、
複数の並列なリンクを介して前記固定部に取り付けられ、前記固定部に対して可動な可動部、
を含み、前記アーム機構に対して4以上の自由度を有するパラレルリンク機構と、
前記可動部に取り付けられ、超音波センサを含む検査器を有するエンドエフェクタと、
制御点の位置又は向きを検出する検出器と、
を含むロボットシステムを制御する制御装置に対して、
前記アーム機構を動かし、前記制御点の姿勢を所定の第1姿勢に設定する第1動作と、
前記第1動作の後に、前記検出器の検出結果に基づいて前記パラレルリンク機構を動かし、前記制御点の前記姿勢を前記エンドエフェクタが作業を実行する作業姿勢に設定する第2動作と、
を実行させ、
前記第2動作の後に、前記超音波センサが作業対象へ超音波を送信したときの反射波の受信結果から、前記作業対象に対する前記検査器の傾きを計算させ、前記傾きが小さくなるように、前記パラレルリンク機構を動作させる、プログラム。 - 前記制御装置に対して、前記第1動作と前記第2動作との間に、
前記検出器の検出結果に基づき、前記作業姿勢までの前記制御点の前記姿勢の変位量を計算する計算処理と、
前記変位量が前記可動部の可動範囲内であるか判定する判定処理と、
をさらに実行させ、
前記判定処理において、前記変位量が前記可動範囲を超えるときには、前記アーム機構を動かして前記制御点の前記姿勢を前記作業姿勢に近づけた後に、前記第2動作を実行させる請求項17記載のプログラム。 - 前記制御装置に対して、前記第1動作と前記第2動作の間に、前記検出器の検出結果に基づいて前記アーム機構を動かし、前記制御点の前記姿勢を補正姿勢に設定する補正動作を実行させ、
前記補正動作において、前記アーム機構の先端部の前記姿勢が特異点近傍を外れるように前記補正姿勢を設定する、請求項17記載のプログラム。 - 前記制御装置に対して、前記エンドエフェクタによる作業の実行中には、前記検出器の検出結果に基づいて前記可動部を動作させ、前記制御点の前記姿勢を調整させる請求項17~19のいずれか1つに記載のプログラム。
- 請求項17~20のいずれか1つに記載のプログラムを記憶した記憶媒体。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020040214A JP7462437B2 (ja) | 2020-03-09 | 2020-03-09 | ロボットシステム、パラレルリンク機構、制御方法、制御装置、プログラム、及び記憶媒体 |
PCT/JP2021/005497 WO2021182024A1 (ja) | 2020-03-09 | 2021-02-15 | ロボットシステム、パラレルリンク機構、制御方法、制御装置、プログラム、及び記憶媒体 |
CN202180019815.2A CN115279555A (zh) | 2020-03-09 | 2021-02-15 | 机器人系统、并联连杆机构、控制方法、控制装置、程序及存储介质 |
EP21766915.9A EP4119301A4 (en) | 2020-03-09 | 2021-02-15 | ROBOT SYSTEM, PARALLEL LINK MECHANISM, CONTROL METHOD, CONTROL DEVICE, PROGRAM, AND STORAGE MEDIUM |
US17/930,270 US20230001581A1 (en) | 2020-03-09 | 2022-09-07 | Robot system, parallel link mechanism, control method, control device, and storage medium |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020040214A JP7462437B2 (ja) | 2020-03-09 | 2020-03-09 | ロボットシステム、パラレルリンク機構、制御方法、制御装置、プログラム、及び記憶媒体 |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2021137939A JP2021137939A (ja) | 2021-09-16 |
JP2021137939A5 JP2021137939A5 (ja) | 2022-11-02 |
JP7462437B2 true JP7462437B2 (ja) | 2024-04-05 |
Family
ID=77667429
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020040214A Active JP7462437B2 (ja) | 2020-03-09 | 2020-03-09 | ロボットシステム、パラレルリンク機構、制御方法、制御装置、プログラム、及び記憶媒体 |
Country Status (5)
Country | Link |
---|---|
US (1) | US20230001581A1 (ja) |
EP (1) | EP4119301A4 (ja) |
JP (1) | JP7462437B2 (ja) |
CN (1) | CN115279555A (ja) |
WO (1) | WO2021182024A1 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7426858B2 (ja) * | 2020-03-10 | 2024-02-02 | 株式会社大気社 | 検査装置及び検査方法 |
JP2023139646A (ja) * | 2022-03-22 | 2023-10-04 | 株式会社東芝 | パラレルリンク機構、ロボット機構、及び制動方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002239958A (ja) | 2001-02-20 | 2002-08-28 | Fukui Prefecture | パラレルメカニズムロボットアーム(2) |
JP2003071760A (ja) | 2001-08-31 | 2003-03-12 | Ricoh Co Ltd | 組立ロボット |
JP2005528993A (ja) | 2002-06-13 | 2005-09-29 | ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツング | デルタロボット |
JP2008126219A (ja) | 2006-11-25 | 2008-06-05 | Hirosaki Univ | 塗布システム |
JP2010082333A (ja) | 2008-10-01 | 2010-04-15 | Tokyo Univ Of Agriculture & Technology | 超音波検査ロボットシステムおよび超音波検査ロボットの制御方法 |
JP2010247238A (ja) | 2009-04-10 | 2010-11-04 | Olympus Corp | パラレルリンクステージおよび光学素子測定装置 |
WO2017017712A1 (en) | 2015-07-30 | 2017-02-02 | Nec Corporation | Linear motion mechanism formed integrally |
JP2018202602A (ja) | 2017-05-31 | 2018-12-27 | セイコーエプソン株式会社 | 制御装置、ロボットおよび制御方法 |
JP2019048343A (ja) | 2017-09-08 | 2019-03-28 | Ntn株式会社 | パラレルリンク機構を用いた作業装置 |
JP2019090727A (ja) | 2017-11-15 | 2019-06-13 | 株式会社東芝 | 検査システム、角度調整方法、プログラム、および記憶媒体 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60249588A (ja) * | 1984-05-24 | 1985-12-10 | 住友電気工業株式会社 | 位置決め機構 |
JPH0677205B2 (ja) * | 1985-06-03 | 1994-09-28 | 株式会社日立製作所 | ロボツトの制御方法 |
DE102016218180B4 (de) * | 2015-09-21 | 2019-12-12 | GM Global Technology Operations LLC | Verlängerte Greifhilfevorrichtung mit erweiterter Reichweite zum Durchführen von Montageaufgaben |
CN107813290A (zh) * | 2016-09-12 | 2018-03-20 | 马建群 | 串并混联机械臂 |
-
2020
- 2020-03-09 JP JP2020040214A patent/JP7462437B2/ja active Active
-
2021
- 2021-02-15 EP EP21766915.9A patent/EP4119301A4/en active Pending
- 2021-02-15 CN CN202180019815.2A patent/CN115279555A/zh active Pending
- 2021-02-15 WO PCT/JP2021/005497 patent/WO2021182024A1/ja active Application Filing
-
2022
- 2022-09-07 US US17/930,270 patent/US20230001581A1/en active Pending
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002239958A (ja) | 2001-02-20 | 2002-08-28 | Fukui Prefecture | パラレルメカニズムロボットアーム(2) |
JP2003071760A (ja) | 2001-08-31 | 2003-03-12 | Ricoh Co Ltd | 組立ロボット |
JP2005528993A (ja) | 2002-06-13 | 2005-09-29 | ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツング | デルタロボット |
JP2008126219A (ja) | 2006-11-25 | 2008-06-05 | Hirosaki Univ | 塗布システム |
JP2010082333A (ja) | 2008-10-01 | 2010-04-15 | Tokyo Univ Of Agriculture & Technology | 超音波検査ロボットシステムおよび超音波検査ロボットの制御方法 |
JP2010247238A (ja) | 2009-04-10 | 2010-11-04 | Olympus Corp | パラレルリンクステージおよび光学素子測定装置 |
WO2017017712A1 (en) | 2015-07-30 | 2017-02-02 | Nec Corporation | Linear motion mechanism formed integrally |
JP2018202602A (ja) | 2017-05-31 | 2018-12-27 | セイコーエプソン株式会社 | 制御装置、ロボットおよび制御方法 |
JP2019048343A (ja) | 2017-09-08 | 2019-03-28 | Ntn株式会社 | パラレルリンク機構を用いた作業装置 |
JP2019090727A (ja) | 2017-11-15 | 2019-06-13 | 株式会社東芝 | 検査システム、角度調整方法、プログラム、および記憶媒体 |
Also Published As
Publication number | Publication date |
---|---|
EP4119301A1 (en) | 2023-01-18 |
US20230001581A1 (en) | 2023-01-05 |
WO2021182024A1 (ja) | 2021-09-16 |
EP4119301A4 (en) | 2024-03-27 |
CN115279555A (zh) | 2022-11-01 |
JP2021137939A (ja) | 2021-09-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108858183B (zh) | 机器人、机器人的控制方法、工件的制造方法 | |
US20230001581A1 (en) | Robot system, parallel link mechanism, control method, control device, and storage medium | |
US10836042B2 (en) | Robot system | |
JP5225867B2 (ja) | ウェイトバランサ及びパイプ結合方法 | |
US8606402B2 (en) | Manipulator and control method thereof | |
JP7143633B2 (ja) | ロボットシステム、制御装置および制御方法 | |
US20120277898A1 (en) | Processing system and processing method | |
JP5531996B2 (ja) | 6軸ロボットの軸間オフセット検出方法 | |
WO2020012710A1 (ja) | マニピュレータ制御装置、マニピュレータ制御方法、及びマニピュレータ制御プログラム | |
JP2012171027A (ja) | ワークピッキングシステム | |
US20230256615A1 (en) | Robot device controller for controlling position of robot | |
JP5672173B2 (ja) | 6軸ロボットの軸間オフセット検出方法 | |
US20190126469A1 (en) | Scara robot | |
JP2019188500A (ja) | ロボットの制御方法 | |
JPS63135814A (ja) | プロ−ブ姿勢制御装置 | |
US11141855B2 (en) | Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article | |
US20160375580A1 (en) | Robot system and robot control method | |
EP4122658A1 (en) | Control device, inspection system, control method, program, and storage medium | |
JP2020142324A (ja) | ロボット装置および自動補正方法 | |
JP2019030923A (ja) | ロボットアーム、ロボット装置、ロボットシステム | |
US20210146542A1 (en) | Control method for robot system | |
JP4745921B2 (ja) | 溶接ロボットの制御方法 | |
JP7131087B2 (ja) | ロボットシステムの制御方法およびロボットシステム | |
Baeten et al. | Tool/camera configurations for eye-in-hand hybrid vision/force control | |
JP2017007082A (ja) | ロボットシステムおよびロボット制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221025 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20221025 |
|
RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20230616 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230725 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230921 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20231215 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240213 |
|
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: 20240226 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240326 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7462437 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |