JP2013107175A - Assembly robot - Google Patents

Assembly robot Download PDF

Info

Publication number
JP2013107175A
JP2013107175A JP2011254953A JP2011254953A JP2013107175A JP 2013107175 A JP2013107175 A JP 2013107175A JP 2011254953 A JP2011254953 A JP 2011254953A JP 2011254953 A JP2011254953 A JP 2011254953A JP 2013107175 A JP2013107175 A JP 2013107175A
Authority
JP
Japan
Prior art keywords
link
workpiece
fitting
hand
joint
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.)
Pending
Application number
JP2011254953A
Other languages
Japanese (ja)
Inventor
Koichiro Nishikawa
幸一郎 西川
清志 ▲高▼木
Kiyoshi Takagi
Takaaki Ashinuma
孝昭 芦沼
Osamu Nagatsuka
修 長塚
Ichiro Okumura
一郎 奥村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Canon Inc
Original Assignee
Canon Inc
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 Canon Inc filed Critical Canon Inc
Priority to JP2011254953A priority Critical patent/JP2013107175A/en
Publication of JP2013107175A publication Critical patent/JP2013107175A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide an assembly robot capable of controlling the position of a workpiece in groping action without sacrificing a servo gain.SOLUTION: A control section 18 energizes a first workpiece 16 in a fitting direction to make a protrusion 41 of the first workpiece 16 contact a second workpiece 17, when carrying out a fitting work by making a hand 8 grip the first workpiece 16. In this state, the control section 18 moves the first workpiece 16 in a groping direction orthogonal to the fitting direction and thereby control a link drive section 30 to carry out the groping action for groping a position where the protrusion 41 of the first workpiece 16 fits in a fitting hole 42 of the second workpiece 17. The control section 18, at the time of groping action, controls the link drive section 30 to regulate the rigidity in the fitting direction a tip 20b of a robot arm 20 to a first rigidity that moves in the opposite direction from the fitting direction by following a reaction force that the first workpiece 16 receives from the second workpiece 17.

Description

本発明は、多関節のロボットアームを備え、ロボットアームの剛性制御を行いながら二つのワークを嵌合させる組立ロボットに関する。   The present invention relates to an assembly robot including an articulated robot arm and fitting two workpieces while performing rigidity control of the robot arm.

従来、組立ロボットとして、多関節のロボットアームと、ロボットアームの先端に設けられたハンドとを備えたものが知られている。この組立ロボットを用いて二つのワークの嵌合作業を行う場合、一般に、組立ロボットに把持されるワークと固定側のワークとの間には位置誤差及び姿勢誤差があり、これが作業に支障を与える。この問題を解決するために、ロボットアームとハンドとの間に、あたかもバネやダンパがあるかのように剛性制御を行いながら、嵌合作業をする方法が良く用いられる。   2. Description of the Related Art Conventionally, as an assembling robot, one having an articulated robot arm and a hand provided at the tip of the robot arm is known. When fitting two workpieces using this assembly robot, there are generally position and orientation errors between the workpiece gripped by the assembly robot and the fixed workpiece, which interferes with the operation. . In order to solve this problem, a method of performing a fitting operation while performing rigidity control as if there is a spring or a damper between the robot arm and the hand is often used.

一般には、力センサで、力、トルク等を検出し、そのフィードバックにより剛性制御を行う。この場合、高価で高精度な力センサが必要となる、或いは、外力を検出してのフィードバックなので迅速性に欠ける、等の問題がある。そこで、力センサ無しでの剛性制御を行う方法が考案されている。   In general, a force sensor detects force, torque, and the like, and performs rigidity control by feedback. In this case, there is a problem that an expensive and highly accurate force sensor is required, or that feedback is detected by detecting an external force, so that it is not quick. Therefore, a method of performing rigidity control without a force sensor has been devised.

例えば、予め、組立ロボットのハンドの動作が嵌合方向となるように、計算・設定しておき、各軸のサーボゲインを小さくして、その状態で位置制御するコンプライアンス動作を実行する(特許文献1参照)。これにより、位置剛性が緩和されているので、組立ロボットのハンドが把持しているワークが固定側のワークに接触し、把持しているワークに外力が働いた場合、所定方向への逃げ追従動作が可能となる。そして、逃げ追従動作によりワーク間の位置誤差が漸次減少して、嵌合作業が終了する。   For example, calculation and setting is performed in advance so that the operation of the hand of the assembly robot is in the fitting direction, the servo gain of each axis is reduced, and the compliance operation for controlling the position in that state is executed (Patent Document) 1). As a result, the positional rigidity is relaxed, so if the workpiece gripped by the assembly robot hand contacts the workpiece on the fixed side and an external force is applied to the gripped workpiece, the follow-up operation in a specified direction Is possible. Then, the position error between the workpieces gradually decreases due to the relief follow-up operation, and the fitting operation is completed.

特許第2682977号公報Japanese Patent No. 2682977

しかしながら、上述した従来例のような、コンプライアンス動作を行う組立ロボットでは、サーボゲインを低下させるので、サーボ応答が遅くなるという問題があった。また、ワークが小さく、ワーク同士が嵌合する嵌合位置を探る探り動作(嵌合方向に直交する探り方向への動作)が必要な場合もある。このような場合、サーボゲインを低下させて探り動作を行うと、探り方向と剛性緩和方向が同じとなり、ワークの位置制御が迅速に行えないという問題があった。   However, the assembly robot that performs the compliance operation as in the conventional example described above has a problem in that the servo response is slowed down because the servo gain is lowered. In some cases, the work is small and a search operation (operation in a search direction orthogonal to the fitting direction) to find a fitting position where the workpieces are fitted to each other is required. In such a case, if the search operation is performed with the servo gain lowered, the search direction and the rigidity relaxation direction become the same, and there is a problem that the position control of the workpiece cannot be performed quickly.

そこで、本発明は、サーボゲインを犠牲にすることなく、探り動作の際に、ワークの位置制御を行う組立ロボットを提供することを目的とするものである。   Therefore, an object of the present invention is to provide an assembly robot that performs position control of a workpiece during a search operation without sacrificing servo gain.

本発明は、第1ワークの突起部を第2ワークの嵌合穴に嵌合させる嵌合作業を行う組立ロボットにおいて、関節で旋回可能に連結された複数のリンクを有するロボットアームと、前記ロボットアームの先端に設けられたハンドと、前記ロボットアームの各リンクを旋回駆動するリンク駆動部と、前記第1ワーク及び前記第2ワークのうちいずれか一方のワークを前記ハンドに把持させて前記嵌合作業を行う際に、前記一方のワークを嵌合方向に付勢して前記第1ワークの突起部を前記第2ワークに接触させた状態で、前記一方のワークを前記嵌合方向と直交する探り方向に移動させて前記第1ワークの突起部が前記第2ワークの嵌合穴に嵌合する位置を探る探り動作を実行するよう前記リンク駆動部を制御する制御部と、を備え、前記制御部は、前記探り動作の実行時に、前記リンク駆動部を制御して、前記ロボットアームの先端における前記嵌合方向の剛性を、前記一方のワークが他方のワークから受ける反力に追従して前記嵌合方向と反対方向に移動する第1剛性に調整すると共に、前記ロボットアームの先端における前記探り方向の剛性を、前記一方のワークが前記他方のワークから受ける反力に抗して前記探り方向の位置を保持する第2剛性に調整する、ことを特徴とする。   The present invention relates to an assembly robot that performs a fitting operation for fitting a projection of a first workpiece into a fitting hole of a second workpiece, a robot arm having a plurality of links that are pivotally connected by joints, and the robot A hand provided at the tip of the arm, a link drive unit that pivotally drives each link of the robot arm, and one of the first work and the second work is held by the hand and the fitting is performed. When performing the joint operation, the one workpiece is perpendicular to the fitting direction in a state where the one workpiece is urged in the fitting direction and the projection of the first workpiece is in contact with the second workpiece. A control unit that controls the link driving unit so as to perform a search operation for searching for a position where the protrusion of the first workpiece is fitted in the fitting hole of the second workpiece by moving in the search direction The control unit When the search operation is performed, the link driving unit is controlled so that the rigidity in the fitting direction at the tip of the robot arm follows the reaction force that the one workpiece receives from the other workpiece. And adjusting the stiffness in the search direction at the tip of the robot arm against the reaction force that the one workpiece receives from the other workpiece in the search direction. It adjusts to the 2nd rigidity which hold | maintains.

本発明によれば、探り動作時に、ロボットアームの先端における嵌合方向の剛性は緩和され、探り方向の剛性は強化されることになるので、探り動作を迅速に行うことが可能となり、嵌合作業をスピードアップすることができる。   According to the present invention, during the search operation, the rigidity in the fitting direction at the tip of the robot arm is relaxed and the rigidity in the search direction is strengthened, so that the search operation can be performed quickly, and the fitting operation is performed. Can speed up the work.

本発明の実施形態に係る組立ロボットの概略構成を示す説明図である。It is explanatory drawing which shows schematic structure of the assembly robot which concerns on embodiment of this invention. 組立ロボットの嵌合作業の動作を説明するためのフローチャートであるIt is a flowchart for demonstrating the operation | movement of the fitting operation | work of an assembly robot. 探り動作及び嵌合動作を説明するための図である。It is a figure for demonstrating search operation | movement and fitting operation | movement. 図1のロボットアームをモデル化した図である。It is the figure which modeled the robot arm of FIG. アクチュエータの粘弾性モデルを示す図である。It is a figure which shows the viscoelasticity model of an actuator. 楕円比α/βに対する相対的発生力を示すグラフである。It is a graph which shows the relative generated force with respect to ellipticity ratio (alpha) / (beta). アクチュエータの別モデルを示す図であるIt is a figure which shows another model of an actuator. 図4のモデルでの各アクチュエータの駆動源の発生力指令値を決定するブロック図である。FIG. 5 is a block diagram for determining a generated force command value of a drive source of each actuator in the model of FIG. 4.

以下、本発明を実施するための形態を、図面を参照しながら詳細に説明する。図1は、本発明の実施形態に係る組立ロボットの概略構成を示す説明図である。図1に示す組立ロボット100は、基台1と、ロボットアーム20と、ハンド8と、リンク駆動部30と、ハンド駆動部15と、制御部18と、を備えている。   Hereinafter, embodiments for carrying out the present invention will be described in detail with reference to the drawings. FIG. 1 is an explanatory diagram showing a schematic configuration of an assembly robot according to an embodiment of the present invention. An assembly robot 100 shown in FIG. 1 includes a base 1, a robot arm 20, a hand 8, a link drive unit 30, a hand drive unit 15, and a control unit 18.

ロボットアーム20は、基台1に固定される固定部としての固定リンク2と、複数(本実施形態では、2つ)のリンク3,4とを有し、これらリンク3,4が関節5,6で旋回可能に連結されてなる。   The robot arm 20 has a fixed link 2 as a fixed portion fixed to the base 1 and a plurality (two in this embodiment) of links 3 and 4, and these links 3 and 4 are joints 5 and 4. 6 is connected so that turning is possible.

具体的に説明すると、固定リンク2の基端2aが基台1に固定される。ロボットアーム20は、複数のリンクとして、基端3aが第1関節5で固定リンク2の先端2bに連結された第1リンク3と、基端4aが第2関節6で第1リンク3の先端3bに連結された第2リンク4とを有する。   More specifically, the base end 2 a of the fixed link 2 is fixed to the base 1. The robot arm 20 includes, as a plurality of links, a first link 3 having a base end 3a connected to the tip 2b of the fixed link 2 by a first joint 5, and a base end 4a having a second joint 6 and a tip of the first link 3. And a second link 4 connected to 3b.

ハンド8は、ロボットアーム20の先端20b、具体的には、第2リンク4の先端4bに旋回可能に設けられている。つまり、ハンド8は、第3関節7で第2リンク4に旋回可能に連結されている。   The hand 8 is pivotably provided at the tip 20b of the robot arm 20, specifically, the tip 4b of the second link 4. That is, the hand 8 is pivotally connected to the second link 4 by the third joint 7.

リンク駆動部30は、各リンク3,4を旋回駆動するものである。リンク駆動部30は、第1関節5を挟んで配置された一対の第1拮抗アクチュエータ9,10と、第2関節6を挟んで配置された一対の第2拮抗アクチュエータ11,12と、を有する。更に、リンク駆動部30は、第1関節5及び第2関節6を挟んで配置された一対の第3拮抗アクチュエータ13,14を有する。   The link drive unit 30 drives the links 3 and 4 to turn. The link drive unit 30 includes a pair of first antagonistic actuators 9 and 10 disposed with the first joint 5 interposed therebetween, and a pair of second antagonistic actuators 11 and 12 disposed with the second joint 6 interposed therebetween. . Furthermore, the link drive unit 30 includes a pair of third antagonistic actuators 13 and 14 disposed with the first joint 5 and the second joint 6 interposed therebetween.

各第1拮抗アクチュエータ9,10の一端は、固定リンク2に接続され、他端は、第1リンク3に接続されている。また、各第2拮抗アクチュエータ11,12の一端は、第1リンク3に接続され、他端は、第2リンク4に接続されている。また、各第3拮抗アクチュエータ13,14の一端は、固定リンク2に接続され、他端は、第2リンク4に接続されている。   One end of each first antagonistic actuator 9, 10 is connected to the fixed link 2, and the other end is connected to the first link 3. One end of each second antagonistic actuator 11, 12 is connected to the first link 3, and the other end is connected to the second link 4. Further, one end of each third antagonistic actuator 13, 14 is connected to the fixed link 2, and the other end is connected to the second link 4.

つまり、第1拮抗アクチュエータ9,10は、固定リンク2に対して第1リンク3を旋回駆動する第1の一関節駆動アクチュエータである。第2拮抗アクチュエータ11,12は、第1リンク3に対して第2リンク4を旋回駆動する第2の一関節駆動アクチュエータである。また、第3拮抗アクチュエータ13,14は、固定リンク2に対して第1リンク3を、第1リンク3に対して第2リンク4を同時に旋回駆動する二関節同時駆動アクチュエータである。本実施形態では、各アクチュエータ9〜14は、McKibben型空気圧アクチュエータ(所謂、人工筋肉アクチュエータ)であり、収縮することで引っ張り力(収縮力)が発生し、弛緩することで、引っ張り力が緩和される。   That is, the first antagonistic actuators 9 and 10 are first joint drive actuators that drive the first link 3 to rotate relative to the fixed link 2. The second antagonistic actuators 11 and 12 are second one-joint drive actuators that drive the second link 4 to rotate with respect to the first link 3. The third antagonistic actuators 13 and 14 are two-joint simultaneous drive actuators that simultaneously drive the first link 3 with respect to the fixed link 2 and the second link 4 with respect to the first link 3. In the present embodiment, each of the actuators 9 to 14 is a McKibben type pneumatic actuator (so-called artificial muscle actuator). When contracted, a tensile force (contracting force) is generated, and by relaxing, the tensile force is relaxed. The

つまり、第1拮抗アクチュエータ9,10の駆動力の差、即ち引っ張り力の差により第1リンク3が固定リンク2に対して相対的に旋回駆動される。また、第2拮抗アクチュエータ11,12の駆動力の差、即ち引っ張り力の差により第2リンク4が第1リンク3に対して相対的に旋回駆動される。また、第3拮抗アクチュエータ13,14の駆動力の差、即ち引っ張り力の差により、第1リンク3及び第2リンク4が同時に旋回駆動される。即ち第1リンク3が固定リンク2に対して相対的に旋回駆動されると共に、第2リンク4が第1リンク3に対して相対的に旋回駆動される。   That is, the first link 3 is driven to rotate relative to the fixed link 2 due to the difference in driving force between the first antagonistic actuators 9, 10, that is, the difference in tensile force. Further, the second link 4 is driven to turn relative to the first link 3 by the difference in driving force between the second antagonistic actuators 11, 12, that is, the difference in tensile force. Further, the first link 3 and the second link 4 are simultaneously turned by the difference in driving force between the third antagonistic actuators 13 and 14, that is, the difference in tensile force. That is, the first link 3 is driven to turn relative to the fixed link 2, and the second link 4 is driven to turn relative to the first link 3.

また、第1拮抗アクチュエータ9,10の駆動力の和、即ち引っ張り力の和により固定リンク2に対する第1リンク3の剛性が設定される。また、第2拮抗アクチュエータ11,12の駆動力の和、即ち引っ張り力の和により第1リンク3に対する第2リンク4の剛性が設定される。更に、第3拮抗アクチュエータ13,14の駆動力の和、即ち引っ張り力の和により、固定リンク2に対する第1リンク3の剛性及び第1リンク3に対する第2リンク4の剛性が設定される。   Further, the rigidity of the first link 3 relative to the fixed link 2 is set by the sum of the driving forces of the first antagonistic actuators 9, 10, that is, the sum of the pulling forces. Further, the rigidity of the second link 4 with respect to the first link 3 is set by the sum of the driving forces of the second antagonistic actuators 11, 12, that is, the sum of the pulling forces. Furthermore, the rigidity of the first link 3 with respect to the fixed link 2 and the rigidity of the second link 4 with respect to the first link 3 are set by the sum of the driving forces of the third antagonistic actuators 13, 14, that is, the sum of the pulling forces.

したがって、これら一対の第1拮抗アクチュエータ9,10、一対の第2拮抗アクチュエータ11,12、一対の第3拮抗アクチュエータ13,14の駆動力を調整することにより、ロボットアーム20の先端20bにおける剛性を設定することができる。   Therefore, by adjusting the driving force of the pair of first antagonist actuators 9 and 10, the pair of second antagonist actuators 11 and 12, and the pair of third antagonist actuators 13 and 14, the rigidity at the tip 20b of the robot arm 20 is increased. Can be set.

ハンド駆動部15は、ハンド8をロボットアーム20の先端20b、即ち第2リンク4の先端4bに対して旋回駆動するものである。このハンド駆動部15は、第2リンク4とハンド8との間の第3関節7に設けられた電動回転モータであり、ハンド8の姿勢を調整することができる。   The hand driving unit 15 drives the hand 8 to pivot with respect to the tip 20 b of the robot arm 20, that is, the tip 4 b of the second link 4. The hand drive unit 15 is an electric rotary motor provided at the third joint 7 between the second link 4 and the hand 8, and can adjust the posture of the hand 8.

制御部18は、リンク駆動部30及びハンド駆動部15を駆動制御して、各リンク3,4及びハンド8に所定の動作を行わせると共に、ロボットアーム20の先端20bの剛性、即ち第2リンク4の先端4bの剛性を制御するものである。   The control unit 18 drives and controls the link driving unit 30 and the hand driving unit 15 to cause each link 3, 4 and hand 8 to perform a predetermined operation, and the rigidity of the tip 20 b of the robot arm 20, that is, the second link. 4 to control the rigidity of the tip 4b.

なお、各関節5,6,7には、旋回角度を検出する角度検出部としてのロータリーエンコーダ21,22,23が組み込まれている。具体的に説明すると、第1の角度検出部としてのロータリーエンコーダ21は、固定リンク2に対する第1リンク3の旋回角度を検出する。第2の角度検出部としてのロータリーエンコーダ22は、第1リンク3に対する第2リンク4の旋回角度を検出する。第3の角度検出部としてのロータリーエンコーダ23は、第2リンク4に対するハンド8の旋回角度を検出する。   Note that rotary encoders 21, 22, and 23 are incorporated in the joints 5, 6, and 7 as angle detection units that detect the turning angle. More specifically, the rotary encoder 21 as the first angle detection unit detects the turning angle of the first link 3 with respect to the fixed link 2. The rotary encoder 22 as the second angle detection unit detects the turning angle of the second link 4 with respect to the first link 3. The rotary encoder 23 as the third angle detection unit detects the turning angle of the hand 8 with respect to the second link 4.

第1ワーク(嵌合ワーク)16は、円柱形状の突起部41を有しており、第2ワーク(被嵌合ワーク)17には、第1ワーク16の突起部41が嵌合する嵌合穴42が形成されている。この嵌合穴42は、穴底面42aと、穴底面42aから垂直に延びる垂直面42bと、垂直面42bの上端に接続され、上方(開放側)に向かって広がるガイド面となる傾斜面42cとで形成されている。   The first work (fitting work) 16 has a cylindrical protrusion 41, and the second work (fitting work) 17 is fitted with the protrusion 41 of the first work 16. A hole 42 is formed. The fitting hole 42 includes a hole bottom surface 42a, a vertical surface 42b extending vertically from the hole bottom surface 42a, and an inclined surface 42c connected to the upper end of the vertical surface 42b and serving as a guide surface extending upward (open side). It is formed with.

ハンド8は、第1ワーク16及び第2ワーク17のいずれか一方のワーク、本実施形態では、第1ワーク16を把持する。他方のワーク、本実施形態では、第2ワーク17は、基台1に載置固定される。   The hand 8 holds one of the first workpiece 16 and the second workpiece 17, in the present embodiment, the first workpiece 16. In the other work, in this embodiment, the second work 17 is placed and fixed on the base 1.

制御部18は、各関節5,6,7に組み込まれたロータリーエンコーダ21,22,23の検出結果(検出角度)に基づき、リンク駆動部30及びハンド駆動部15の駆動を制御することで、ロボットアーム20及びハンド8を動作させる。また、制御部18は、リンク駆動部30、即ち各アクチュエータ9〜14の駆動を制御することで、ロボットアーム20の先端20b(第2リンク4の先端4b)における剛性を制御する。   The control unit 18 controls the driving of the link driving unit 30 and the hand driving unit 15 based on the detection results (detection angles) of the rotary encoders 21, 22, and 23 incorporated in the joints 5, 6, and 7, respectively. The robot arm 20 and the hand 8 are operated. Further, the control unit 18 controls the rigidity of the distal end 20b of the robot arm 20 (the distal end 4b of the second link 4) by controlling the driving of the link driving unit 30, that is, the actuators 9 to 14.

具体的には、制御部18は、第1関節5及び第2関節6における回転角度(旋回角度)と、ロボットアーム20の先端20bにおける目標の剛性特性のパラメータとにより、各アクチュエータ9〜14での発生力を計算する。そして、制御部18は、各アクチュエータ9〜14に発生力指令を出力し、各アクチュエータ9〜14に発生力指令に対応する発生力を発生させ、ロボットアーム20の先端20bにおける剛性を目標の剛性に調整する。   Specifically, the control unit 18 uses each of the actuators 9 to 14 based on the rotation angle (turning angle) of the first joint 5 and the second joint 6 and the target stiffness characteristic parameter of the tip 20b of the robot arm 20. Calculate the generation force. Then, the control unit 18 outputs a generated force command to each of the actuators 9 to 14 to generate a generated force corresponding to the generated force command to each of the actuators 9 to 14, and the rigidity at the tip 20b of the robot arm 20 is set to a target rigidity. Adjust to.

図2は、組立ロボット100の嵌合作業の動作を説明するためのフローチャートであり、図3は、探り動作及び嵌合動作を説明するための図である。以下、図2及び図3を参照して、図1に示されている組立ロボット100の動作について述べる。以下の説明において、第2ワーク17の嵌合穴42の延びる方向、及び固定リンク2の延びる方向と平行な軸をv軸とする。また、v軸に垂直な方向の軸をh軸とする。   FIG. 2 is a flowchart for explaining the operation of the assembling work of the assembly robot 100, and FIG. 3 is a diagram for explaining the searching operation and the fitting operation. Hereinafter, the operation of the assembly robot 100 shown in FIG. 1 will be described with reference to FIGS. 2 and 3. In the following description, an axis parallel to the extending direction of the fitting hole 42 of the second workpiece 17 and the extending direction of the fixed link 2 is defined as a v-axis. In addition, an axis in a direction perpendicular to the v-axis is an h-axis.

まず、嵌合作業の前工程について説明する。基台1の所定の位置には、第2ワーク17が、作業者又は他のロボットなどによって、嵌合穴42が上方を向く所定姿勢で固定される。   First, the pre-process of the fitting operation will be described. The second workpiece 17 is fixed to a predetermined position of the base 1 in a predetermined posture in which the fitting hole 42 faces upward by an operator or another robot.

制御部18は、予め定められた動作指令によって、第1ワーク16をハンド8に把持させ、第1ワーク16の突起部41の延びる方向と第2ワーク17の嵌合穴42の延びる方向とが平行となるように、各関節5,6,7における関節角度(旋回角度)を調整する。   The control unit 18 causes the hand 8 to grip the first workpiece 16 according to a predetermined operation command, and the direction in which the protrusion 41 of the first workpiece 16 extends and the direction in which the fitting hole 42 of the second workpiece 17 extends are determined. The joint angles (turning angles) at the joints 5, 6, and 7 are adjusted so as to be parallel.

この時、嵌合作業前の段階なので、ハンド8の位置制御、即ち、各関節5,6,7の角度制御のみが行われ、ロボットアーム20全体として高剛性が要件となっている。これは、拮抗配置されている一対の第1拮抗アクチュエータ9,10、一対の第2拮抗アクチュエータ11,12、一対の第3拮抗アクチュエータ13,14の駆動源のそれぞれの発生力の和が大きくなるように設定することで実現される。   At this time, since it is a stage before the fitting operation, only the position control of the hand 8, that is, the angle control of each joint 5, 6, 7 is performed, and the robot arm 20 as a whole is required to have high rigidity. This is because the sum of the generated forces of the drive sources of the pair of first antagonist actuators 9 and 10, the pair of second antagonist actuators 11 and 12, and the pair of third antagonist actuators 13 and 14 arranged in an antagonistic manner is increased. This is realized by setting as follows.

また、以降の作業時は、ハンド8の姿勢を嵌合時の基準姿勢に保持する。この基準姿勢は、予め、冶工具等を用いて、作業開始以前に第1ワーク16と第2ワーク17の嵌合方向に設定される。具体的には、固定リンク2に対する第1リンク3の旋回角度と、第1リンク3に対する第2リンク4の旋回角度と、第2リンク4に対するハンド8の旋回角度との和が一定なるように制御することで達成される。本実施形態では、制御部18は、その和を180°に制御する。オフセット誤差は、冶工具等を用いた初期調整で吸収する。   Further, during the subsequent work, the posture of the hand 8 is held at the reference posture at the time of fitting. This reference posture is set in advance in the fitting direction of the first workpiece 16 and the second workpiece 17 before starting work using a tool or the like. Specifically, the sum of the turning angle of the first link 3 with respect to the fixed link 2, the turning angle of the second link 4 with respect to the first link 3, and the turning angle of the hand 8 with respect to the second link 4 is made constant. This is achieved by controlling. In the present embodiment, the control unit 18 controls the sum to 180 °. The offset error is absorbed by initial adjustment using a tool or the like.

このように、ハンド8に第1ワーク16を把持させて、第2ワーク17が基台1にセットされた後、組立ロボット100は、第1ワーク16の突起部41を第2ワーク17の嵌合穴42に嵌合させる嵌合作業を行う。   Thus, after the first work 16 is gripped by the hand 8 and the second work 17 is set on the base 1, the assembly robot 100 inserts the protrusion 41 of the first work 16 into the second work 17. A fitting operation for fitting the fitting hole 42 is performed.

具体的に説明すると、まず、制御部18は、リンク駆動部30を制御して、ロボットアーム20の先端20bにおける嵌合方向(v軸方向の負方向)の剛性を、低剛性である第1剛性に調整する(S100)。このとき、制御部18は、リンク駆動部30を制御して、ロボットアーム20の先端20bにおける嵌合方向と直交する探り方向(h軸方向)の剛性を、第1剛性よりも高い高剛性である第2剛性に調整する。ここで、第1剛性は、第1ワーク16が第2ワーク17から受ける反力に追従して嵌合方向と反対方向に移動する剛性に設定される。これにより、第1ワーク16を嵌合方向に移動させる際に、ハンド8の位置での嵌合方向の剛性が緩和される。また、第2剛性は、第1ワーク16が第2ワーク17から受ける反力に抗して探り方向(v軸方向に直交するh軸方向)の位置を保持する剛性に設定される。つまり、第2剛性は、第1ワーク16が第2ワーク17から受ける反力によっても移動しない程度の剛性である。   More specifically, first, the control unit 18 controls the link driving unit 30 so that the rigidity in the fitting direction (the negative direction in the v-axis direction) at the tip 20b of the robot arm 20 is a low-stiffness first. The rigidity is adjusted (S100). At this time, the control unit 18 controls the link driving unit 30 so that the rigidity in the probe direction (h-axis direction) orthogonal to the fitting direction at the tip 20b of the robot arm 20 is higher than the first rigidity. Adjust to a certain second stiffness. Here, the first stiffness is set to a stiffness that moves in the direction opposite to the fitting direction following the reaction force that the first workpiece 16 receives from the second workpiece 17. Thereby, when moving the 1st workpiece | work 16 to a fitting direction, the rigidity of the fitting direction in the position of the hand 8 is relieve | moderated. The second stiffness is set to a stiffness that maintains the position in the probe direction (h-axis direction orthogonal to the v-axis direction) against the reaction force that the first workpiece 16 receives from the second workpiece 17. That is, the second rigidity is a rigidity that does not move even by the reaction force that the first work 16 receives from the second work 17.

そして、制御部18は、リンク駆動部30及びハンド駆動部15を制御して、第1ワーク16を嵌合方向(v軸方向の負方向)に移動させ、第1ワーク16の突起部41を第2ワーク17に接触させる(S101)。このとき、制御部18は、第1ワーク16を嵌合方向に付勢して第1ワーク16の突起部41を第2ワーク17に接触させた状態を保持させる。つまり、第1ワーク16の突起部41は、第2ワーク17に押し付けられた状態で保持されている。制御部18は、リンク駆動部30を制御して第1ワーク16を第2ワーク17に接触させる際に、ハンド駆動部15を制御して突起部41と嵌合穴42との平行状態を維持している。   Then, the control unit 18 controls the link driving unit 30 and the hand driving unit 15 to move the first work 16 in the fitting direction (the negative direction of the v-axis direction), and the protrusion 41 of the first work 16 is moved. The second workpiece 17 is brought into contact (S101). At this time, the control unit 18 urges the first work 16 in the fitting direction so as to keep the projection 41 of the first work 16 in contact with the second work 17. That is, the protrusion 41 of the first work 16 is held in a state of being pressed against the second work 17. When the control unit 18 controls the link driving unit 30 to bring the first workpiece 16 into contact with the second workpiece 17, the control unit 18 controls the hand driving unit 15 to maintain the parallel state of the protrusion 41 and the fitting hole 42. doing.

この際、第1ワーク16の突起部41のv軸方向の目標位置は、設計上、微小量だけ嵌合した状態の位置に設定する。或いは、v軸方向の目標位置を少しずつ更新しながら、各関節5,6,7に組み込まれたロータリーエンコーダ21,22,23の出力をモニタして、その変化より接触を知る方法でも良い。つまり、第1剛性に設定されたことにより、第2ワーク17の反力が作用した第1ワーク16に押されてロボットアーム20の各リンク3,4が旋回し、これに伴って制御部18は、ハンド8が所定の姿勢を保つためにハンド8を旋回される。そして、制御部18は、各ロータリーエンコーダ21,22,23の検出結果に基づき、第1ワーク16が第2ワーク17に接触したか否かを判断する。   At this time, the target position in the v-axis direction of the protruding portion 41 of the first workpiece 16 is set to a position where only a minute amount is fitted in design. Alternatively, a method may be used in which the outputs of the rotary encoders 21, 22, and 23 incorporated in the joints 5, 6, and 7 are monitored while the target position in the v-axis direction is updated little by little, and the contact is known from the change. That is, since the first rigidity is set, the links 3 and 4 of the robot arm 20 are turned by being pushed by the first work 16 to which the reaction force of the second work 17 is applied, and the control unit 18 is accordingly turned. The hand 8 is turned to keep the hand 8 in a predetermined posture. Then, the control unit 18 determines whether or not the first workpiece 16 has contacted the second workpiece 17 based on the detection results of the rotary encoders 21, 22 and 23.

通常は、図3(a)の状態で突起部41が第2ワーク17に接触する。この場合、両ワーク16,17間に力が働くが、予め、ロボットアーム20の先端20bにおける嵌合方向の剛性が緩和されているので、ワーク16,17間に働く力は緩和される。   Usually, the protrusion 41 contacts the second workpiece 17 in the state of FIG. In this case, a force is applied between the workpieces 16 and 17, but since the rigidity in the fitting direction at the tip 20b of the robot arm 20 is reduced in advance, the force applied between the workpieces 16 and 17 is reduced.

次に、制御部18は、探り動作を行いながら位置(v、h)測定値を更新していく(S102)。探り動作は、以下のように制御部18により実行される。つまり、制御部18は、リンク駆動部30及びハンド駆動部15を制御し、突起部41を第2ワーク17に接触させた状態で、第1ワーク16を探り方向(h軸方向)に移動させて第1ワーク16の突起部41が第2ワーク17の嵌合穴42に嵌合する位置を探る。 Next, the control unit 18 updates the position (v n , h n ) measurement value while performing a search operation (S102). The search operation is executed by the control unit 18 as follows. That is, the control unit 18 controls the link driving unit 30 and the hand driving unit 15 to move the first workpiece 16 in the search direction (h-axis direction) in a state where the projection 41 is in contact with the second workpiece 17. Thus, the position where the projection 41 of the first workpiece 16 is fitted into the fitting hole 42 of the second workpiece 17 is searched.

具体的に説明すると、制御部18は、予め調整設定された微小目標変位γ(>0)、δ(>0)を用いて、v軸方向の突起部41の目標位置をv−γとし、第1ワーク16の突起部41を第2ワーク17に接触させる。また、制御部18は、h軸方向の探り動作の1回目は、目標位置をh1+δ、2回目は、目標位置をh2−2・δ、3回目は、目標位置をh3+3・δのように更新する。 Specifically, the control unit 18 uses the minute target displacements γ (> 0) and δ (> 0) adjusted and set in advance as the target position of the protrusion 41 in the v-axis direction as v n −γ. The protrusion 41 of the first work 16 is brought into contact with the second work 17. The control unit 18 updates the target position to h1 + δ for the first h-axis direction search operation, updates the target position to h2-2 · δ for the second time, and updates the target position to h3 + 3 · δ for the third time. To do.

このとき、制御部18は、探り動作の実行時に、突起部41の延びる方向と嵌合穴42の延びる方向とが平行な状態を維持するように、各ロータリーエンコーダ21,22,23の検出結果に基づいて、ハンド駆動部15を制御する。このように制御することで、制御部18は、突起部41を探り動作させたときのv軸方向の位置の変化を正確に把握することができる。なお、探り動作は、本実施形態では初期位置を中心に探る方法であるが、方向毎に所定距離を探る方法等でも良い。この探り動作の実行時に、ロボットアーム20の先端20bにおける探り方向の剛性は、第2剛性と高いままなので、迅速な探り位置制御が可能となっている。   At this time, the control unit 18 detects the detection results of the rotary encoders 21, 22, and 23 so that the extending direction of the protrusion 41 and the extending direction of the fitting hole 42 are maintained in parallel when the search operation is performed. Based on the above, the hand drive unit 15 is controlled. By controlling in this way, the control part 18 can grasp | ascertain correctly the change of the position of the v-axis direction when the projection part 41 is searched and operated. In this embodiment, the search operation is a method of searching centering on the initial position, but a method of searching for a predetermined distance for each direction may be used. At the time of performing this search operation, the rigidity in the search direction at the tip 20b of the robot arm 20 remains as high as the second rigidity, so that quick search position control is possible.

次に、制御部18は、探り動作毎に、更新された測定値より|vn+1−v|を評価、つまり、vn+1−vの値の絶対値が所定の値Δ以上か否かを判断する(S103)。 Next, for each search operation, the control unit 18 evaluates | v n + 1 −v n | from the updated measurement value, that is, whether or not the absolute value of the value of v n + 1 −v n is equal to or greater than a predetermined value Δ. Is determined (S103).

そして、制御部18は、   Then, the control unit 18

Figure 2013107175
の場合(S103:YES)は、有意な変化ありとして、次のステップの処理に移る。
Figure 2013107175
In the case of (S103: YES), it is determined that there is a significant change, and the process proceeds to the next step.

また、制御部18は、   In addition, the control unit 18

Figure 2013107175
の場合(S103:NO)は、有意な変化無しとして、探り動作を継続する。ここで、通常は、図3(a)の初期の状態から、探り動作により図3(b)の状態となるので、有意な変化は負値となる。ステップS101のワーク間接触時に図3(b)の接触状態のとき、ロボットアーム20の先端20bにおける嵌合方向の剛性は緩和されている。従って、探り動作により図3(b)中右方向に突起部41を移動させようとする場合、第2ワーク17の傾斜面42cにより第1ワーク16の突起部41に働く外力Fexは、図3(b)中白抜き矢印で示すように、v軸正方向となり、有意な変化Δは正値となる。なお、所定の値Δは、予備実験等によりv軸方向位置測定誤差を求め、例えば、その2倍程度に設定しておく。
Figure 2013107175
In the case of (S103: NO), the search operation is continued with no significant change. Here, since the state of FIG. 3B is normally changed from the initial state of FIG. 3A to the state of FIG. 3B by the search operation, the significant change becomes a negative value. When the contact state between the workpieces in step S101 is the contact state of FIG. 3B, the rigidity in the fitting direction at the tip 20b of the robot arm 20 is relaxed. Therefore, when trying to move the protrusion 41 to the right in FIG. 3B by the search operation, the external force F ex acting on the protrusion 41 of the first work 16 by the inclined surface 42c of the second work 17 is 3 (b) As indicated by the outlined arrow, the positive direction is the v-axis, and the significant change Δ is a positive value. Note that the predetermined value Δ is obtained by obtaining a position measurement error in the v-axis direction by a preliminary experiment or the like, and is set to about twice that, for example.

次に、制御部18は、有意な変化Δがあった場合(S103:YES)、つまり、図3(c)に示す状態となった場合、これまで高剛性であった嵌合方向に垂直な探り方向(h軸方向)の剛性を低剛性に緩和する(S104)。つまり、制御部18は、コンプライアンス動作を実行する。この際、ロボットアーム20の先端20bにおける嵌合方向の剛性はそのままでも良いし、剛性を上げても良いが、望ましくは、剛性を上げる。   Next, when there is a significant change Δ (S103: YES), that is, when the control unit 18 is in the state shown in FIG. 3C, the control unit 18 is perpendicular to the fitting direction that has been highly rigid so far. The rigidity in the search direction (h-axis direction) is reduced to low rigidity (S104). That is, the control unit 18 performs a compliance operation. At this time, the rigidity in the fitting direction at the tip 20b of the robot arm 20 may be as it is, or the rigidity may be increased, but the rigidity is preferably increased.

このコンプライアンス動作実行時、突起部41のv軸方向の位置は、v−ζを目標位置として設定される。そこで、本実施形態においては、ハンド8(つまり、ロボットアーム20の先端20b)における剛性特性は、その分布がv−h軸に長短軸が平行な楕円形状となるように制御されている。その結果、変位方向(探り方向)と平行な力が発生するので、h軸に平行な負方向の微小な力が突起部41に加わっている。 When this compliance operation is executed, the position of the protrusion 41 in the v-axis direction is set with v n −ζ as a target position. Therefore, in the present embodiment, the stiffness characteristics of the hand 8 (that is, the tip 20b of the robot arm 20) are controlled so that the distribution thereof is an elliptical shape whose major and minor axes are parallel to the vh axis. As a result, since a force parallel to the displacement direction (probing direction) is generated, a minute force in the negative direction parallel to the h-axis is applied to the protrusion 41.

従って、第2ワーク17の嵌合穴42の傾斜面42cより第1ワーク16の突起部41に働く外力Fexは、図3(c)中白抜き矢印で示すように、第2ワーク17の嵌合穴42中心軸方向となる(逃げ追従動作)。 Therefore, the external force F ex acting on the protrusion 41 of the first workpiece 16 from the inclined surface 42c of the fitting hole 42 of the second workpiece 17 is as shown by the white arrow in FIG. It becomes the center axis direction of the fitting hole 42 (escape following operation).

結果、最終的は、(v、h)値の更新は無くなり、第1ワーク16の突起部41と第2ワーク17の嵌合穴42との嵌合が達成される。   As a result, finally, the (v, h) value is not updated, and the fitting between the projection 41 of the first workpiece 16 and the fitting hole 42 of the second workpiece 17 is achieved.

以上のように、本実施形態では、探り動作中にサーボゲインを落とすことなく、ワーク間の接触状況の変化が見られたら、剛性の特性を変えるので、迅速な嵌合作業が可能となる。つまり、探り動作時に、ロボットアーム20の先端20bにおける嵌合方向の剛性は緩和され、探り方向の剛性は強化されることになるので、探り動作を迅速に行うことが可能となり、嵌合作業をスピードアップすることができる。   As described above, according to the present embodiment, if the change in the contact state between the workpieces is observed without reducing the servo gain during the search operation, the rigidity characteristic is changed, so that a quick fitting operation can be performed. In other words, during the search operation, the rigidity in the fitting direction at the tip 20b of the robot arm 20 is alleviated and the rigidity in the search direction is strengthened, so that the search operation can be performed quickly and the fitting operation can be performed. You can speed up.

次に、ハンド8(ロボットアーム20の先端20b)の剛性特性をコントロール方法について詳細に説明する。図4は、図1のロボットアーム20をモデル化した図である。以下の説明では、重力及び摩擦等の影響は無視する。   Next, a method for controlling the rigidity characteristics of the hand 8 (the tip 20b of the robot arm 20) will be described in detail. FIG. 4 is a diagram in which the robot arm 20 of FIG. 1 is modeled. In the following description, the effects of gravity and friction are ignored.

v−h軸をx−y軸とし、第1リンク3をL、そのリンク長をl、第2リンク4をL、そのリンク長をlとする。また、アクチュエータ9をe、アクチュエータ10をf、アクチュエータ11をe、アクチュエータ12をf、2リンク同時アクチュエータ13をe、2リンク同時アクチュエータ14をfとする。また、第1関節5周りのトルクをT、第2関節6周りのトルクをTとして表し、第1リンクLとx軸のなす角をθ、第1リンクLと第2リンクLとのなす角をθとする。さらに、第1関節5と第2関節6のモーメントアームをrとする。 The vh axis is the xy axis, the first link 3 is L 1 , the link length is l 1 , the second link 4 is L 2 , and the link length is l 2 . The actuator 9 is e 1 , the actuator 10 is f 1 , the actuator 11 is e 2 , the actuator 12 is f 2 , the two-link simultaneous actuator 13 is e 3 , and the two-link simultaneous actuator 14 is f 3 . Further, the torque around the first joint 5 is represented as T 1 , the torque around the second joint 6 is represented as T 2 , the angle formed by the first link L 1 and the x axis is θ 1 , and the first link L 1 and the second link. The angle formed by L 2 is θ 2 . Furthermore, let r be the moment arm of the first joint 5 and the second joint 6.

また、アクチュエータe、f、e、f、e、fも筋の粘弾性モデルで表す。McKibben型空気圧アクチュエータは、筋の粘弾性モデルを具現化するものの代表である。 The actuators e 1 , f 1 , e 2 , f 2 , e 3 , and f 3 are also represented by muscle viscoelastic models. McKibben type pneumatic actuators are representative of those that embody muscle viscoelastic models.

図5は、アクチュエータの粘弾性モデルを示す図である。このモデルでは、バネ成分及びダンパ成分を持ったアクチュエータとして表わされ、出力Fは、以下の式(1)のように数式化されることが知られている。   FIG. 5 is a diagram illustrating a viscoelastic model of the actuator. This model is expressed as an actuator having a spring component and a damper component, and the output F is known to be expressed by the following equation (1).

Figure 2013107175
Figure 2013107175

バネ成分、ダンパ成分の係数は筋肉の収縮力uに比例する関数として表され、収縮力uの設定がモデルのアクチュエータの剛性設定となる。k、bはそれぞれ比例定数、xは自然長からの変位である。   The coefficients of the spring component and the damper component are expressed as a function proportional to the contraction force u of the muscle, and the setting of the contraction force u is the stiffness setting of the model actuator. k and b are proportional constants, respectively, and x is a displacement from the natural length.

周知のように、手先Wでの剛性は、一般に、微小外力ΔF、ΔFによるリンク先端の微小変位をΔx、Δyとすると、以下の式(2)となる。 As is well known, the rigidity at the hand W is generally expressed by the following equation (2), where Δx t and Δy t are the minute displacements of the link tip caused by minute external forces ΔF x and ΔF y .

Figure 2013107175
Figure 2013107175

したがって、手先Wでの剛性は、以下の式(3)に相似の楕円形状で表され、スティフネス楕円と称される。   Therefore, the rigidity at the hand W is represented by an elliptical shape similar to the following formula (3), and is referred to as a stiffness ellipse.

Figure 2013107175
Figure 2013107175

上述した組立ロボット100では、先ず、ステップS100で、コンプライアンス方向をx軸方向(v軸方向)に設定、即ち、y軸方向(h軸方向)の剛性がx軸方向(v軸方向)の剛性よりも高い状態に設定する。次に、ステップS104で、コンプライアンス方向をy軸方向(h軸方向)に設定、即ち、x軸方向(v軸方向)の剛性がy軸方向(h軸方向)の剛性よりも高い状態に設定する。   In the assembly robot 100 described above, first, in step S100, the compliance direction is set to the x-axis direction (v-axis direction), that is, the rigidity in the y-axis direction (h-axis direction) is the rigidity in the x-axis direction (v-axis direction). Set to a higher state. Next, in step S104, the compliance direction is set to the y-axis direction (h-axis direction), that is, the rigidity in the x-axis direction (v-axis direction) is set higher than the rigidity in the y-axis direction (h-axis direction). To do.

その際、スティフネス楕円は、長短軸がx−y軸に平行な楕円であることが望まれ、式(4)が条件となる。   At that time, it is desirable that the stiffness ellipse is an ellipse whose major and minor axes are parallel to the xy axis, and Equation (4) is a condition.

Figure 2013107175
Figure 2013107175

スティフネス楕円の軸長を2α、2βとすると、以下の式(5)のように表せる。   If the axial length of the stiffness ellipse is 2α and 2β, it can be expressed as the following equation (5).

Figure 2013107175
Figure 2013107175

従って、スティフネス楕円は、図4のようになる。各アクチュエータの駆動源の収縮力をue1、uf1、ue2、uf2、ue3、uf3として、各拮抗対に対応する和をU、U、Uとする。図4のように、粘弾性を有するアクチュエータが拮抗に配置されていると、その収縮力の各和U、U、Uを制御することにより、手先Wでの剛性が制御できる。 Therefore, the stiffness ellipse is as shown in FIG. The contraction force of the drive source of each actuator is set to u e1 , u f1 , u e2 , u f2 , u e3 , u f3 , and the sum corresponding to each antagonistic pair is set to U 1 , U 2 , U 3 . As shown in FIG. 4, when the actuator having viscoelasticity is arranged in an antagonistic manner, the rigidity at the hand W can be controlled by controlling the sum U 1 , U 2 , U 3 of the contraction force.

即ち、微小な外力ΔF、ΔFによる、関節の微小な回転角度をΔθ、Δθとすると、筋の粘弾性を有するアクチュエータは、筋の弾性力によりリンクに微小なトルクΔTp1、ΔTp2を発生させ、式(6),(7)の関係で表されることが知られている。 That is, if the minute rotation angles of the joints by the minute external forces ΔF x and ΔF y are Δθ 1 and Δθ 2 , the actuator having muscle viscoelasticity has a minute torque ΔT p1 and ΔT applied to the link by the muscle elastic force. It is known that p2 is generated and expressed by the relationship of the equations (6) and (7).

Figure 2013107175
Figure 2013107175

式(6),(7)から判るように、U+U、U+U、Uを大きく設定すると、各関節での剛性は高まる。そして、式(5)より、U+U、U+U、Uを大きく設定すると、α、βも大きくなることが判る。 As can be seen from the equations (6) and (7), when U 1 + U 3 , U 2 + U 3 , and U 3 are set large, the rigidity at each joint increases. From the equation (5), it can be seen that if U 1 + U 3 , U 2 + U 3 , and U 3 are set large, α and β also increase.

そこで、式(8)はヤコビ行列である。   Therefore, Equation (8) is a Jacobian matrix.

Figure 2013107175
Figure 2013107175

この式(8)のヤコビ行列を導入すると、以下の式(9),(10)の関係がある。   When the Jacobian matrix of the equation (8) is introduced, the following equations (9) and (10) are related.

Figure 2013107175
Figure 2013107175

よって、これらの式(9),(10)から、以下の式(11),(12)が導かれる。   Therefore, the following formulas (11) and (12) are derived from these formulas (9) and (10).

Figure 2013107175
Figure 2013107175

x−y軸に平行なスティフネス楕円を得るためには、以下の式(13)となる。   In order to obtain a stiffness ellipse parallel to the xy axis, the following equation (13) is obtained.

Figure 2013107175
Figure 2013107175

所望のα、βと、第1リンクLのリンク長l、第2リンクLのリンク長l、第1リンクLとx軸のなす角θ、第1リンクLと第2リンクLのなす角θ、アクチュエータのバネ定数k、第1関節5と第2関節6のモーメントアームrを代入する。これらを代入した式(13)の連立方程式を解くことで、U、U、Uの値が得られる。 Desired alpha, and beta, link length l 1 of the first link L 1, the link length l 2 of the second link L 2, the first link L 1 and the angle theta 1 of the x-axis, the first link L 1 and the The angle θ 2 formed by the two links L 2 , the spring constant k of the actuator, and the moment arm r of the first joint 5 and the second joint 6 are substituted. The values of U 1 , U 2 , and U 3 can be obtained by solving the simultaneous equations of Equation (13) into which these are substituted.

ここで、例を示す。l=0.6[m]、l=0.8[m]、k=3、r=0.1[m]とする。 Here is an example. Let l 1 = 0.6 [m], l 2 = 0.8 [m], k = 3, and r = 0.1 [m].

case1: θ=50[°]、θ=80[°]
case2: θ=60[°]、θ=90[°]
case3: θ=70[°]、θ=100[°]
に関して、α=βの時のUを1として、αβ一定のもと、α/β、即ち、楕円比をパラメータとしてグラフ化したものを図6に示す。図6は、楕円比α/βに対する相対的発生力を示すグラフであり、図6(a)はcase1を、図6(b)はcase2を、図6(c)はcase3を示している。図6(a)〜図6(c)より、Uを大きく、Uを小さくするに連れて、α/βを大きくすることでき、Uを小さく、Uを大きくするに連れて、α/βを小さくすることができることが判る。
case1: θ 1 = 50 [°], θ 2 = 80 [°]
case2: θ 1 = 60 [°], θ 2 = 90 [°]
case3: θ 1 = 70 [°], θ 2 = 100 [°]
FIG. 6 shows a graph of α / β, that is, the ellipticity ratio as a parameter, with U 1 being 1 when α = β and αβ constant. FIG. 6 is a graph showing the relative generated force with respect to the ellipticity ratio α / β. FIG. 6A shows case 1, FIG. 6B shows case 2, and FIG. 6C shows case 3. From FIG. 6A to FIG. 6C, as U 1 is increased and U 2 is decreased, α / β can be increased, and as U 1 is decreased and U 2 is increased, It can be seen that α / β can be reduced.

ここで、α/βの比を変えなければ、U、U、Uの大小関係、比率は変わらず、α/β一定の下でのα、βに比例する。このように、所定の条件下で、所望のα、βが決まれば、U、U、Uは、一意的に決められることが判る。 Here, if the ratio of α / β is not changed, the magnitude relationship and ratio of U 1 , U 2 , and U 3 are not changed, and are proportional to α and β under constant α / β. Thus, it can be seen that U 1 , U 2 , and U 3 can be uniquely determined if desired α and β are determined under predetermined conditions.

従って、図2に示すフローチャートに従うと、ステップS100では、α/βを1よりも大きめの値に設定し、嵌合方向の剛性を緩和する。ステップS104では、α/βが1よりも小さく変化するように設定し、嵌合方向に垂直な方向の剛性を緩和する。   Therefore, according to the flowchart shown in FIG. 2, in step S100, α / β is set to a value larger than 1, and the rigidity in the fitting direction is relaxed. In step S104, α / β is set to change to be smaller than 1, and the rigidity in the direction perpendicular to the fitting direction is relaxed.

ここで、Uは収縮力の和を示しているので、McKibben型空気圧アクチュエータのように伸長力が無い場合、U、U、Uは負の値を採らない。 Since U n represents the sum of the contraction force, if there is no stretching force as McKibben type pneumatic actuator, U 1, U 2, U 3 does not take the negative value.

よって、本実施形態のようにMcKibben型空気圧アクチュエータを使う場合、ステップS100ではU→+0(非負のゼロに近い値)となる(U、U、U)のセットを指令値とする。ステップS104ではU→+0(非負のゼロに近い値)となる(U、U、U)のセットを指令値とする。 Therefore, when the McKibben type pneumatic actuator is used as in this embodiment, a set of U 1 → + 0 (value close to non-negative zero) (U 1 , U 2 , U 3 ) is set as the command value in step S100. . In step S104, a set of (U 1 , U 2 , U 3 ) that satisfies U 2 → + 0 (value close to non-negative zero) is set as a command value.

尚、式(1)で近似され、伸長力も発生するアクチュエータが使用できる場合、U、U、Uは負の値も採れるので、α/βの大小がより明瞭となり、所定方向以外の剛性を上げられるで、より外乱等に強い安定した装置が実現できる。 When an actuator that is approximated by equation (1) and generates an extension force can be used, U 1 , U 2 , and U 3 can also take negative values, so that the magnitude of α / β becomes clearer, and other than the predetermined direction. Since the rigidity can be increased, a stable device that is more resistant to external disturbances can be realized.

そのようなアクチュエータのモデルとしては、図7に示すようなものが考えられる。   A model as shown in FIG. 7 is conceivable as a model of such an actuator.

駆動源51は、モータ、減速機等からなる。駆動源の駆動量をL、直列のバネ要素のバネ定数kとすると、以下の式(14)となる。   The drive source 51 includes a motor, a speed reducer, and the like. When the drive amount of the drive source is L and the spring constant k of the series spring element, the following equation (14) is obtained.

Figure 2013107175
Figure 2013107175

バネ定数が、uに依存すると、Fは出力端からの出力、xを出力端の変位として、以下の式(15)となる。   If the spring constant depends on u, F is an output from the output end, and x is a displacement of the output end, the following equation (15) is obtained.

Figure 2013107175
Figure 2013107175

式(15)は、式(1)と同等となる(粘性項は除く)。そして、駆動源51の駆動量Lは極性を問わないので、収縮、伸長の力を発生することができる。   Equation (15) is equivalent to Equation (1) (excluding the viscosity term). And since the drive amount L of the drive source 51 does not ask | require polarity, it can generate | occur | produce the force of shrinkage | contraction and expansion | extension.

以上のようにして、U、U、Uを決めることが、各拮抗対としてのアクチュエータ(eとf、eとf、eとf)の剛性を決めることになり、この(U、U、U)のセットにより手先Wでの剛性の特性を決定する。 As described above, determining U 1 , U 2 , and U 3 determines the rigidity of the actuators (e 1 and f 1 , e 2 and f 2 , e 3 and f 3 ) as each antagonistic pair. Thus, the rigidity characteristic at the hand W is determined by the set of (U 1 , U 2 , U 3 ).

次に、手先Wの出力と変位について簡単に説明する。上述したようなv軸方向は、v−γとする場合のように、現在位置を基準とした目標変位をΔx、Δyとする。対応する第1関節5と第2関節6の各々の回転変位をδθ、δθとして、その関係は、式(9)と同等に考えられて、以下のように変換される。 Next, the output and displacement of the hand W will be briefly described. In the v-axis direction as described above, the target displacements based on the current position are set as Δx and Δy, as in the case of v n −γ. Assuming that the rotational displacements of the corresponding first joint 5 and second joint 6 are δθ 1 and δθ 2 , the relationship is considered equivalent to the equation (9), and is converted as follows.

Figure 2013107175
Figure 2013107175

従って、(θ、θ)→(θ+δθ、θ+δθ)として、新たな目標回転変位として、第1関節5と第2関節6の各エンコーダ値をモニタしながら、第1関節5と第2関節6へのトルク印加により、位置制御する。すると、現在位置を基準とした目標変位Δx、Δyへと到達する。 Therefore, as (θ 1 , θ 2 ) → (θ 1 + δθ 1 , θ 2 + δθ 2 ), the first target 5 and the second joint 6 are monitored as encoder values of the first joint 5 as the new target rotational displacement. The position is controlled by applying torque to the joint 5 and the second joint 6. Then, the target displacements Δx and Δy with the current position as a reference are reached.

そして、その結果のトルクを(T、T)に関して、図4のようなモデルの場合、以下の式(17)のように表せることが知られている(粘性項は省略)。 Then, it is known that the resulting torque can be expressed by the following equation (17) in the case of a model as shown in FIG. 4 with respect to (T 1 , T 2 ) (viscous term is omitted).

Figure 2013107175
Figure 2013107175

ここで、1以下の実数ε、ε、εを用いると、各収縮力は以下の式(18)となる。 Here, when real numbers ε 1 , ε 2 , and ε 3 of 1 or less are used, each contraction force is expressed by the following equation (18).

Figure 2013107175
Figure 2013107175

すると、式(17)は、以下の式(19)となる。   Then, Expression (17) becomes the following Expression (19).

Figure 2013107175
Figure 2013107175

従って、2つの関節を同時駆動する拮抗アクチュエータの存在により、所定のトルクに対して、解析的、かつ一意的には、各拮抗対をなすアクチュエータの駆動源の出力差、即ちε、ε、εを決定できない。 Therefore, due to the existence of the antagonistic actuator that drives the two joints simultaneously, the output difference between the driving sources of the actuators forming each antagonistic pair, that is, ε 1 , ε 2 , analytically and uniquely for a predetermined torque. , Ε 3 cannot be determined.

しかし、上述したように、所望のα、βと、目標のθ、θよりU、U、Uの値が得られるので、ε=0.5やε=ε、或いは、ε/ε=一定、等々の条件下で位置制御(回転変位)により、制御結果として、ε、ε、εが決定される。 However, as described above, since the values of U 1 , U 2 , and U 3 can be obtained from the desired α and β and the target θ 1 and θ 2 , ε 3 = 0.5 or ε 1 = ε 2 , Alternatively, ε 1 / ε 2 = constant, the position control under the conditions of so (rotational displacement), as a control result, ε 1, ε 2, ε 3 are determined.

ここで、式(5)が成り立つ場合、手先での発生力をΔF、ΔFとすると、以下の式(20)が成り立つことが確認されている。 Here, when the formula (5) holds, it is confirmed that the following formula (20) holds if the generated force at the hand is ΔF x and ΔF y .

Figure 2013107175
Figure 2013107175

従って、微小目標変位を与えることにより微小力を発生でき、しかも、力の方向と変位の方向を揃えることができる。即ち、例えば、Δxを与え続けることにより、ΔFを加え続けることができる。 Therefore, a minute force can be generated by giving a minute target displacement, and the direction of the force and the direction of the displacement can be aligned. That is, for example, by adding Δx, ΔF x can be continuously added.

図8に、図4のモデルでの各アクチュエータの駆動源の発生力指令値を決定するブロック図である。θ、θは更新した値としている。 FIG. 8 is a block diagram for determining the generated force command value of the drive source of each actuator in the model of FIG. θ 1 and θ 2 are updated values.

所望のα、βと、目標のθ、θよりU、U、Uの値が得られる。そして、位置制御(回転位置)の過程で、ε、ε、εが決定され、その結果として、各アクチュエータe、f、e、f、e、fへの収縮力指令値ue1、uf1、ue2、uf2、ue3、uf3が決まる。 The values of U 1 , U 2 , U 3 are obtained from the desired α, β and the target θ 1 , θ 2 . Then, in the process of position control (rotational position), ε 1 , ε 2 , ε 3 are determined, and as a result, contraction to each actuator e 1 , f 1 , e 2 , f 2 , e 3 , f 3 Force command values u e1 , u f1 , u e2 , u f2 , u e3 , u f3 are determined.

図1に示す構成で説明すると、以下のようになる。制御部18は、各関節5,6,7に組み込まれたロータリーエンコーダ21,22,23の出力に基づいて、ハンド駆動部15を駆動制御し、ハンド8の姿勢を一定にする。即ち制御部18は、固定リンク2に対する第1リンク3の旋回角度と第1リンク3に対する第2リンク4の旋回角度と、第2リンク4に対するハンド8の旋回角度の和が一定(本実施形態では180°、つまり突起部41と嵌合穴42とが平行)となるように制御する。   The description of the configuration shown in FIG. 1 is as follows. The control unit 18 drives and controls the hand driving unit 15 based on the outputs of the rotary encoders 21, 22, and 23 incorporated in the joints 5, 6, and 7 to make the posture of the hand 8 constant. That is, the control unit 18 has a constant sum of the turning angle of the first link 3 with respect to the fixed link 2, the turning angle of the second link 4 with respect to the first link 3, and the turning angle of the hand 8 with respect to the second link 4 (this embodiment). Then, it is controlled to be 180 °, that is, the protrusion 41 and the fitting hole 42 are parallel to each other.

制御部18は、各関節に組み込まれたロータリーエンコーダの出力から、固定リンク2基準の第1リンク3の旋回角度と第1リンク3基準の第2リンク4の旋回角度を求める。   The control unit 18 obtains the turning angle of the first link 3 based on the fixed link 2 and the turning angle of the second link 4 based on the first link 3 from the output of the rotary encoder incorporated in each joint.

そして、制御部18は、予め設定された第1リンク3及び第2リンク4のリンク長、第1関節6、第2関節7のモーメントアーム値を用いて、所望のα、βから各拮抗対のアクチュエータの駆動源の発生力指令値の和を決定する。その和を条件として、微小目標変位への位置制御により、結果として、各アクチュエータの駆動源の発生力指令値が決められ、モデルの手先Wに相当するハンド8での剛性の特性と励起される力の方向と大きさが決定される。そして、この概念に従って、図2に示されるフローチャートの各処理が実行される。   Then, the control unit 18 uses the preset link lengths of the first link 3 and the second link 4 and the moment arm values of the first joint 6 and the second joint 7 to calculate each antagonistic pair from desired α and β. The sum of generated force command values of the actuator drive source is determined. As a result, the generated force command value of the drive source of each actuator is determined by the position control to the minute target displacement on the condition of the sum, and excited with the rigidity characteristic of the hand 8 corresponding to the hand W of the model. The direction and magnitude of the force is determined. Then, according to this concept, each process of the flowchart shown in FIG. 2 is executed.

なお、本発明は、以上説明した実施形態に限定されるものではなく、多くの変形が本発明の技術的思想内で当分野において通常の知識を有する者により可能である。   The present invention is not limited to the embodiments described above, and many modifications can be made by those having ordinary knowledge in the art within the technical idea of the present invention.

上記実施形態では、一方のワークとして、ハンド8に第1ワーク16を把持させて嵌合作業を行う場合について説明したが、ハンド8に第2ワーク17を把持させて嵌合作業を行うようにしてもよい。   In the above embodiment, the case where the first work 16 is held by the hand 8 and the fitting work is performed as one work has been described. However, the fitting work is performed by holding the second work 17 by the hand 8. May be.

また、上記実施形態では、他方のワークを基台1に載置固定する場合について説明したが、不図示の別のロボットハンドに他方のワークを把持させている場合であってもよい。   In the above embodiment, the case where the other work is placed and fixed on the base 1 has been described. However, the other work may be held by another robot hand (not shown).

1…基台、2…固定リンク(固定部)、3…第1リンク、4…第2リンク、5…第1関節、6…第2関節、7…第3関節、8…ハンド、9,10…一対の第1拮抗アクチュエータ、11,12…一対の第2拮抗アクチュエータ、13,14…一対の第3拮抗アクチュエータ、15…ハンド駆動部、16…第1ワーク、17…第2ワーク、18…制御部、20…ロボットアーム、20b…先端、30…リンク駆動部、41…突起部、42…嵌合穴、100…組立ロボット DESCRIPTION OF SYMBOLS 1 ... Base, 2 ... Fixed link (fixed part), 3 ... 1st link, 4 ... 2nd link, 5 ... 1st joint, 6 ... 2nd joint, 7 ... 3rd joint, 8 ... Hand, 9, DESCRIPTION OF SYMBOLS 10 ... A pair of 1st antagonistic actuator, 11, 12 ... A pair of 2nd antagonistic actuator, 13, 14 ... A pair of 3rd antagonistic actuator, 15 ... Hand drive part, 16 ... 1st workpiece | work, 17 ... 2nd workpiece | work, 18 ... Control part, 20 ... Robot arm, 20b ... Tip, 30 ... Link drive part, 41 ... Protrusion, 42 ... Fitting hole, 100 ... Assembly robot

Claims (3)

第1ワークの突起部を第2ワークの嵌合穴に嵌合させる嵌合作業を行う組立ロボットにおいて、
関節で旋回可能に連結された複数のリンクを有するロボットアームと、
前記ロボットアームの先端に設けられたハンドと、
前記ロボットアームの各リンクを旋回駆動するリンク駆動部と、
前記第1ワーク及び前記第2ワークのうちいずれか一方のワークを前記ハンドに把持させて前記嵌合作業を行う際に、前記一方のワークを嵌合方向に付勢して前記第1ワークの突起部を前記第2ワークに接触させた状態で、前記一方のワークを前記嵌合方向と直交する探り方向に移動させて前記第1ワークの突起部が前記第2ワークの嵌合穴に嵌合する位置を探る探り動作を実行するよう前記リンク駆動部を制御する制御部と、を備え、
前記制御部は、前記探り動作の実行時に、前記リンク駆動部を制御して、前記ロボットアームの先端における前記嵌合方向の剛性を、前記一方のワークが他方のワークから受ける反力に追従して前記嵌合方向と反対方向に移動する第1剛性に調整すると共に、前記ロボットアームの先端における前記探り方向の剛性を、前記一方のワークが前記他方のワークから受ける反力に抗して前記探り方向の位置を保持する第2剛性に調整する、
ことを特徴とする組立ロボット。
In an assembly robot that performs a fitting operation for fitting the protrusion of the first workpiece into the fitting hole of the second workpiece,
A robot arm having a plurality of links pivotably connected by joints;
A hand provided at the tip of the robot arm;
A link drive unit for driving to turn each link of the robot arm;
When one of the first workpiece and the second workpiece is gripped by the hand and the fitting operation is performed, the one workpiece is urged in the fitting direction to With the projections in contact with the second workpiece, the one workpiece is moved in a search direction perpendicular to the fitting direction so that the projection of the first workpiece fits into the fitting hole of the second workpiece. A control unit that controls the link driving unit so as to perform a search operation for searching for a position to be combined,
The control unit controls the link driving unit during execution of the search operation so that the rigidity in the fitting direction at the tip of the robot arm follows the reaction force that the one workpiece receives from the other workpiece. And adjusting the stiffness in the probe direction at the tip of the robot arm against the reaction force received by the one workpiece from the other workpiece. Adjust to the second stiffness that holds the position in the search direction,
An assembly robot characterized by that.
前記ロボットアームは、基台に固定された固定部と、
前記複数のリンクとして、第1関節で前記固定部に連結された第1リンク、及び第2関節で前記第1リンクに連結された第2リンクと、を有し、
前記リンク駆動部は、前記第1関節を挟んで前記固定部と前記第1リンクとに接続され、駆動力の差により前記第1リンクを旋回駆動する一対の第1拮抗アクチュエータと、
前記第2関節を挟んで前記第1リンクと前記第2リンクとに接続され、駆動力の差により前記第2リンクを旋回駆動する一対の第2拮抗アクチュエータと、
前記第1関節及び前記第2関節を挟んで前記固定部と前記第2リンクとに接続され、駆動力の差により前記第1リンク及び前記第2リンクを旋回駆動する一対の第3拮抗アクチュエータと、を有する、
ことを特徴とする請求項1に記載の組立ロボット。
The robot arm includes a fixed portion fixed to a base;
As the plurality of links, a first link connected to the fixed portion at a first joint, and a second link connected to the first link at a second joint,
The link driving unit is connected to the fixed unit and the first link across the first joint, and a pair of first antagonistic actuators that pivotally drive the first link by a difference in driving force;
A pair of second antagonistic actuators that are connected to the first link and the second link across the second joint and that pivotally drive the second link by a difference in driving force;
A pair of third antagonistic actuators connected to the fixed portion and the second link across the first joint and the second joint, and configured to turn the first link and the second link by a difference in driving force; Having
The assembly robot according to claim 1.
前記ハンドを旋回駆動して前記ハンドの姿勢を調整するハンド駆動部を備え、
前記制御部は、前記探り動作の実行時に、前記突起部と前記嵌合穴とが平行な状態を維持するように前記ハンド駆動部を制御する、
ことを特徴とする請求項2に記載の組立ロボット。
A hand drive unit for turning the hand to adjust the posture of the hand;
The control unit controls the hand driving unit so as to maintain the projection and the fitting hole in a parallel state when the search operation is performed.
The assembly robot according to claim 2, wherein:
JP2011254953A 2011-11-22 2011-11-22 Assembly robot Pending JP2013107175A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2011254953A JP2013107175A (en) 2011-11-22 2011-11-22 Assembly robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011254953A JP2013107175A (en) 2011-11-22 2011-11-22 Assembly robot

Publications (1)

Publication Number Publication Date
JP2013107175A true JP2013107175A (en) 2013-06-06

Family

ID=48704498

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011254953A Pending JP2013107175A (en) 2011-11-22 2011-11-22 Assembly robot

Country Status (1)

Country Link
JP (1) JP2013107175A (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015062971A (en) * 2013-09-24 2015-04-09 本田技研工業株式会社 Robot
JP6376296B1 (en) * 2017-02-09 2018-08-22 三菱電機株式会社 Position control device and position control method
JP2020179440A (en) * 2019-04-24 2020-11-05 セイコーエプソン株式会社 Display method
WO2021111701A1 (en) * 2019-12-05 2021-06-10 三菱電機株式会社 Connector fitting device and connector fitting method
CN114310978A (en) * 2020-09-28 2022-04-12 株式会社日立制作所 Clamped object insertion device and method

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015062971A (en) * 2013-09-24 2015-04-09 本田技研工業株式会社 Robot
JP6376296B1 (en) * 2017-02-09 2018-08-22 三菱電機株式会社 Position control device and position control method
JP2020179440A (en) * 2019-04-24 2020-11-05 セイコーエプソン株式会社 Display method
JP7318295B2 (en) 2019-04-24 2023-08-01 セイコーエプソン株式会社 Display method
WO2021111701A1 (en) * 2019-12-05 2021-06-10 三菱電機株式会社 Connector fitting device and connector fitting method
JPWO2021111701A1 (en) * 2019-12-05 2021-06-10
CN114746226A (en) * 2019-12-05 2022-07-12 三菱电机株式会社 Connector fitting device and connector fitting method
JP7186900B2 (en) 2019-12-05 2022-12-09 三菱電機株式会社 Connector fitting device and connector fitting method
CN114746226B (en) * 2019-12-05 2024-03-08 三菱电机株式会社 Connector fitting device and connector fitting method
CN114310978A (en) * 2020-09-28 2022-04-12 株式会社日立制作所 Clamped object insertion device and method
CN114310978B (en) * 2020-09-28 2024-02-02 株式会社日立制作所 Clip insertion device and method

Similar Documents

Publication Publication Date Title
JP4271249B2 (en) Mating device
US9221176B2 (en) Robot system and method for controlling the same
US10618164B2 (en) Robot system having learning control function and learning control method
JP5327722B2 (en) Robot load estimation apparatus and load estimation method
JP4319232B2 (en) Power assist device and control method thereof
JP2013107175A (en) Assembly robot
CN110405753B (en) Robot control device and robot system
JPWO2017064851A1 (en) Robot teaching method and robot arm control device
US20110301758A1 (en) Method of controlling robot arm
CN104589304A (en) Robot control device and robot
JP5318727B2 (en) Information processing method, apparatus and program
US10987742B2 (en) Method of controlling positioning control apparatus and positioning control apparatus
WO2017047048A1 (en) Device and method for positioning processing tool
WO2018212265A1 (en) Robot system and robot system control method
EP2907599B1 (en) Peening device and peening method
Petrone et al. Time-optimal trajectory planning with interaction with the environment
JP6705847B2 (en) Robot system for performing learning control based on processing result and control method thereof
Lange et al. Revised force control using a compliant sensor with a position controlled robot
JP6697544B2 (en) Optimizer and vertical articulated robot equipped with the same
JPH0796427A (en) Control device for robot
US20170043481A1 (en) Robot controller inhibiting shaking of tool tip in robot equipped with travel axis
JPH06143171A (en) Robot
JP6091272B2 (en) Spring constant correction device for articulated robot
JP2020142324A (en) Robot device and automatic correction method
JP5290934B2 (en) Information processing method, apparatus and program

Legal Events

Date Code Title Description
RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20130228