JPH1097315A - Control method for robot - Google Patents

Abstract

PROBLEM TO BE SOLVED: To impart applicability and expansibility to the operating function of the robot by defining the position of a final operation unit, relating the defined positions of respective operation units and the fitting position for the final operation unit of the robot with each other according to a coordinate system exchange matrix, and operating the robot according to the matrix. SOLUTION: A final operation unit coordinate system 3 which is different in position, etc., from the wrist 10 of the robot where the final operation unit 11 is fitted is defined as to respective final opration units 11. This method is equipped with the coordinate system exchange matrix having position conversion, etc., for relating the respective defined final operation unit coordinate systems 3 and the coordinate system 2 of the wrist 10 of the robot with each other. The coordinate system exchange matrix is added to coordinate converting operation that relates the angles of rotation of an actuator of the robot with the wrist 10 of the robot and the actuator of the robot to make the robot passible to operate with an OPERATION instruction such as a position given according to respective final operation unit coordinate systems 3 different from the wrist 10 of the robot.

Description

【発明の詳細な説明】 【０００１】 【産業上の利用分野】本発明は複数種のハンド、ツー
ル、検出器等の最終作用器のうち任意の最終作用器が取
付可能であってその最終作用器が所望の軌道を描くよう
にしたロボットの制御方法に関するものである。 【０００２】 【従来の技術】ロボットはその動作が自由に変化できる
点が１つの存在理由となっている。しかしロボットは、
システム的に固有の動作機能をもっておりそれらの組み
合わせにより全体の動作を変化させているのが一般的で
あった。これでは前記固有な動作機能がロボット使用者
にとって不都合な場合、その固有な動作をなさしめるシ
ステム自体を改変する必要があり、実際には不可能であ
ることが殆んどであった。このことは、ロボットに別の
作業、役割をさせる場合についても同様であり、従来の
ロボットは動作上の応用性、拡張性に極めて劣るもので
あった。 【０００３】また、従来、ＩＥＥＥ ＴＲＡＮＳＡＣＴ
ＩＯＮＳ ＯＮ ＳＹＳＴＥＭＳ，ＭＡＮ， ＡＮＤ
ＣＹＢＥＲＮＥＴＩＣＳ， ＶＯＬ．ＳＭＣ−１１，Ｎ
ｏ．４，ＡＰＲＩＬ １９８１ （アイイイー トラン
ザクションズ オン システムズ マン アンド サイ
バネチックス ボリュウム エムエムシ−１１ ナンバ
ーヨン エイプリール １９８１）（ｐｐ．２７４〜２
８９）に記載があるように、ロボットの最終作用器取付
け部位の座標系と最終作用器の座標系に分けてティーチ
ングならびに動作のプログラミングをし、ロボットの動
作経路のポイント−ポイントを上記座標系間の変換を用
いてより簡便にティーチングやプログラミングをできる
ようにしたロボットの制御方法である。 【０００４】 【発明が解決しようとする課題】上記従来技術では、ロ
ボットのプレーバック時並びにティーチング時にポイン
ト−ポイントの間の経路補間時に最終作用器の座標系と
最終作用器取付け部位の座標系との間の座標変換を行っ
ていないため、経路補間中の軌道が所望の軌道を通ら
ず、障害物に当たるなどの問題が生じる。 【０００５】本発明は上記のような実情に鑑みてなされ
たもので、選択された最終作用器の種類、機能およびロ
ボットへの取付部位に応じて適宜最終作用器座標系が選
択され、最終作用器が所望の軌道を描くようにして動作
機能の応用性、拡張性をもたせたロボットの制御方法を
提供することを目的とする。 【０００６】 【課題を解決するための手段】本発明は、従来ロボット
における制御部位を最終作用器取付部位とし、そこに取
り付けられた最終作用器の種類、機能に応じて決定され
る最終作用器座標系、換言すれば最終作用器の位置（姿
勢）を定義し、その定義された各最終作用器の位置とロ
ボットの最終作用器取付部位とを座標系変換マトリック
スで相互に関係づけ、そのマトリックスに基づいてロボ
ットを動作させるようにしたもので、本来ロボットがも
っている動作機能を、ロボット固有の部位ではなくロボ
ットに取り付けられた最終作用器に応じた座標系に対し
てもたせ、これによりロボットの動作機能に応用性、拡
張性をもたせたものである。 【０００７】 【実施例】以下、前記座標系変換マトリックスについて
説明する。 【０００８】ロボットの基本動作にはロボット各軸のア
クチュエータ単位の移動誤差があるが、ここではその説
明を省略し、高機能ロボットの特徴である手元の直線移
動と姿勢移動動作の補間に関して説明する。すなわち、
高機能ロボットには、これらの位置の移動補間と姿勢の
移動動作の補間が有り、それらの動作機能が基本的に要
求され、従来から何らかの方法でそれを実現している。 【０００９】ここでは図１に示すように６軸の自由度を
有するロボットの旋回軸にＺ軸をとった直交座標系をロ
ボットのシステム上の基本静止座標系１とする。Ｘ
（ｉ）軸、Ｙ（ｊ）軸、Ｚ（ｋ）軸はここでの主方向で
あり、単位ベクトルの成分で表わすと、 Ｘ軸（１００） Ｙ軸（０１０） Ｚ軸（００１） である。ここで、図１に示すようにロボットの手先１０
に同じ様な直交座標系を定義し、これを手先座標系２と
称する。この手先座標系２は前記静止座標系１にと成分表示できる。なお、ロボットの姿勢（位置）を角
度で表わすか単位ベクトルの方向余弦を成分としたマト
リックスで表わすかはロボットのシステムにより任意に
決めて差し支えないが、ここでは方向余弦を成分とした
マトリックスで表わす。 【００１０】ここで、位置と方向を合わせて記号化して
マトリックス〔Ｌ〕を と定義すると、ロボットの位置教示はこのマトリックス
〔Ｌ〕を求めることに他ならない。すなわち、ロボット
の動作は、このデータであるマトリックス〔Ｌ〕の成分
を他のマトリックス〔Ｌ〕の成分とで補間し、時間的に
連続に動かして他のマトリックス〔Ｌ〕の位置に移動さ
せることであり、ロボットの動作機能は、究極的に前記
補間とどのマトリックス〔Ｌ〕の成分を選択的に変化さ
せるかで決 により他の成分を変化させればよい。 【００１１】 によればよい。これは他の成分の変化であっても同様で
ある。 【００１２】なお、図１において、４〜９はロボットの
関節、θ₁〜θ₆はそれら関節４〜９の回転角度を示す。 【００１３】次に、図２に基づいて本発明方法の具体例
について説明する。図２はロボットの手先座標系と最終
作用器座標系の関数を示す図で、図中３は最終作用器座
標系、１１はハンド、ツール、検出器等の最終作用器で
ある。その他は図１と同様であるが、手先１０は、ここ
では最終作用器１１の取付部位となっている。この図２
において、最終作用器１１の位置成分マトリックス
〔Ｑ〕を前述マトリックス〔Ｌ〕と同様にしてで表わされる。そしてこの（４）式中のλθ₁〜λθ₃、
λａ₁〜λａ₃、λｂ₁〜λｂ₃およびλｃ₁〜λｃ₃の各定
数を適宜定めることにより手先座標系２とは別の所望の
最終作用器座標系３を定義したことになる。また、
（４）式を整理し、 〕からマトリクス〔Ｌ〕を求めることもできる。 【００１４】さて、一般に、ロボットの動作機能は手先
座標系２について固有のシステムによって固定化されて
おり、その変更は容易でない。しかし、前記マトリクス
〔Ｌ〕とマトリクス〔Ｑ〕は同一性質機能を持つもので
あり、ロボットが持っているマトリクス〔Ｌ〕を操作す
る動作機能をそのままマトリクス〔Ｑ〕に適用しても何
ら不都合は生じない。すなわち、図３に示すロボットの
動作機能を実現するフローチャートにおいて、ステップ
１０３「（４）式の逆行列の実行」を追加するだけで任
意かつ簡単にロボットの動作機能を最終作用器１１から
その取付部の座標に変更することが可能となる。（４）
式を無効にし、ロボットの動作機能を手先１０側に戻す
には（４）式中の定数を、 λθ₁〜λθ₃＝φ λａ₁＝λｂ₂＝λｃ₃＝１ λａ₂，λａ₃＝λｂ₁，λｂ₃＝λｃ₁，λｃ₂＝φ と定めればよい。 【００１５】従って、ロボットの制御装置にステップ１
０３を実行するブロックを追加すれば、ロボットの動作
機能を任意に変化させることが可能となり応用性、拡張
性のあるロボットが達成できる。 【００１６】ここで、一応用例として、ロボットの手先
１０を円弧運動させる方法について図２に基づき説明し
ておく。すなわち、ロボットの手先１０を点１２を中心
に円弧を描かせるには単に点１２を前記（４）式中の定
数によってマトリクス〔Ｑ〕 すればよく、他に特別な計算をすることなく簡単に行な
わせることが可能である。 【００１７】なお、図３において、１００〜１０４は、
各々図中に記載の動作を実行するステップを指す。 【００１８】 【発明の効果】以上述べたように本発明によれば、最終
作用器が取り付けられるロボットの部位に対し、選択さ
れた最終作用器の種類、機能に応じて決定される最終作
用器座標系を定義し、その定義された各最終作用器座標
系とロボットの最終作用器取付部位とを相互に関係づけ
る座標系変換マトリクスを備え、このマトリクスに基づ
いてロボットの運動を支持することにより、プレーバッ
ク時および動作教示時にロボットの最終作用器に対し
て、適した運動を精度良く、容易に提供できる。Description: BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention is capable of mounting any final actuator among a plurality of final actuators such as hands, tools, detectors, etc., and the final operation thereof. The present invention relates to a method for controlling a robot in which a container follows a desired trajectory. 2. Description of the Related Art One of the reasons for existence of a robot is that its operation can be freely changed. But the robot
It is common to have operation functions unique to the system and change the entire operation by a combination of them. In this case, when the specific operation function is inconvenient for the robot user, it is necessary to modify the system for performing the specific operation, which is almost impossible in practice. The same is true for the case where the robot performs another task or role. The conventional robot is extremely inferior in operational applicability and expandability. [0003] Conventionally, IEEE TRANSACT has been proposed.
IONS ON SYSTEMS, MAN, AND
CYBERNETICS, VOL. SMC-11, N
o. 4, APRIL 1981 (III Transactions on Systems Man and Cybernetics Volume MM-11 Numberyon April 1981) (pp. 274-2)
As described in 89), teaching and operation are separately programmed into the coordinate system of the robot's final actuator attachment site and the final actuator's coordinate system, and the points of the robot's operation path are defined between the coordinate systems. This is a control method of a robot that enables teaching and programming to be performed more easily by using the conversion. In the above prior art, the coordinate system of the final actuator and the coordinate system of the site where the final actuator is attached are used when the robot interpolates the path between points during playback and teaching. Is not performed, the trajectory during the path interpolation does not pass through the desired trajectory, causing a problem such as hitting an obstacle. The present invention has been made in view of the above circumstances, and a final operating unit coordinate system is appropriately selected in accordance with the type and function of the selected final operating unit and a portion to be attached to the robot. It is an object of the present invention to provide a control method of a robot having an applicability and expandability of an operation function in such a manner that a container follows a desired trajectory. According to the present invention, a control portion of a conventional robot is used as a final actuator mounting portion, and the final actuator determined according to the type and function of the final actuator attached thereto. The coordinate system, in other words, the position (posture) of the final actuator, is defined, and the defined final actuator position and the final actuator attachment site of the robot are related to each other by a coordinate system conversion matrix, and the matrix is defined. The robot is operated based on the robot, and the motion function originally possessed by the robot is given not to the robot-specific part but to the coordinate system according to the final actuator attached to the robot, thereby making the robot operate. It is a function that has applicability and expandability to the operation function. Hereinafter, the coordinate system transformation matrix will be described. Although the basic motion of the robot has a movement error for each actuator of each axis of the robot, its description is omitted here, and the interpolation of the linear movement and the posture movement of the hand, which is a feature of the high-performance robot, will be described. . That is,
High-performance robots include movement interpolation of these positions and interpolation of movement of attitude, and these movement functions are basically required, and conventionally realized by some method. Here, as shown in FIG. 1, a rectangular coordinate system in which the robot has six degrees of freedom and the Z axis is taken as the turning axis is a basic stationary coordinate system 1 on the robot system. X
The (i) axis, the Y (j) axis, and the Z (k) axis are the main directions here, and when expressed by a component of a unit vector, they are X axis (100), Y axis (010), and Z axis (001). . Here, as shown in FIG.
Defines a similar orthogonal coordinate system, which is referred to as a hand coordinate system 2. This hand coordinate system 2 is the same as the stationary coordinate system 1 described above. And the component can be displayed. Whether the posture (position) of the robot is represented by an angle or a matrix containing the direction cosine of a unit vector as a component may be arbitrarily determined by the robot system, but is represented here by a matrix containing the direction cosine as a component. . [0010] Here, the matrix [L] is symbolized by matching the position and the direction to form a matrix [L]. , The position teaching of the robot is nothing less than finding this matrix [L]. In other words, the operation of the robot is to interpolate the components of the matrix [L], which is this data, with the components of the other matrix [L], and move them continuously in time to move to the position of the other matrix [L]. Ultimately, the operation function of the robot is determined by the interpolation and which matrix [L] component is selectively changed. May be used to change other components. [0011] According to. This applies to changes in other components. In FIG. 1, 4 to 9 indicate the joints of the robot, and θ _{1 to} θ ₆ indicate the rotation angles of the joints 4 to 9. Next, a specific example of the method of the present invention will be described with reference to FIG. FIG. 2 is a diagram showing functions of the robot's hand coordinate system and the final operator coordinate system. In the figure, reference numeral 3 denotes a final operator coordinate system, and reference numeral 11 denotes a final operator such as a hand, a tool, and a detector. The rest is the same as that of FIG. 1, but the hand 10 is a mounting portion of the final actuator 11 here. This figure 2
In the above, the position component matrix [Q] of the final actuator 11 is set in the same manner as the aforementioned matrix [L]. Is represented by Λθ ₁ to λθ ₃ in the equation (4),
By appropriately setting the constants of λa _{1 to} λa ₃ , λb _{1 to} λb _3, and λc _{1 to} λc ₃ , a desired final actuator coordinate system 3 different from the hand end coordinate system 2 is defined. Also,
(4) Rearrange the formula, ] To obtain the matrix [L]. In general, the operation function of the robot is fixed by a system unique to the hand coordinate system 2, and its change is not easy. However, the matrix [L] and the matrix [Q] have the same property function. Even if the operation function for operating the matrix [L] possessed by the robot is applied to the matrix [Q] as it is, there is no inconvenience. Does not occur. That is, in the flowchart for realizing the operation function of the robot shown in FIG. 3, the operation function of the robot can be arbitrarily and easily attached from the final actuator 11 only by adding step 103 “Execute the inverse matrix of equation (4)”. It is possible to change to the coordinates of the part. (4)
In order to invalidate the expression and return the operation function of the robot to the hand 10 side, the constants in the expression (4) are expressed as follows: λθ ₁ -λθ ₃ = φλa ₁ = λb ₂ = λc ₃ = 1 λa ₂ , λa ₃ = λb ₁ , λb ₃ = λc ₁ and λc ₂ = φ. Therefore, step 1 is performed by the robot controller.
By adding a block that executes step 03, the operation function of the robot can be arbitrarily changed, and a robot having applicability and expandability can be achieved. Here, as one application example, a method of causing the robot's hand 10 to make a circular motion will be described with reference to FIG. That is, in order for the robot hand 10 to draw an arc around the point 12, the point 12 is simply expressed by a matrix [Q] using the constant in the above equation (4). It is possible to perform the calculation easily without any special calculation. Incidentally, in FIG.
Each refers to the step of performing the operation described in the figure. As described above, according to the present invention, the final actuator determined according to the type and function of the final actuator selected for the robot part to which the final actuator is attached. By defining a coordinate system and providing a coordinate system conversion matrix that correlates each defined final actuator coordinate system with the final actuator mounting portion of the robot, and supporting the motion of the robot based on this matrix. In addition, a suitable motion can be easily and accurately provided to the final actuator of the robot at the time of the playback and the operation teaching.

【図面の簡単な説明】 【図１】ロボットの基本静止座標系と手先座標系の関係
を示す図である。 【図２】本発明に係るロボットの制御方法を説明するた
めの図であり、ロボットの手先座標系と最終作用器座標
系の関係を示す図である。 【図３】本発明に係るロボットの制御方法を適したロボ
ットの動作を示すフローチャートである。 【符号の説明】 １…基本静止座標系、２…手先座標系、３…最終作用器
座標系、４、５、６、７、８、９…関節、１０…手先、
１１…最終作用器BRIEF DESCRIPTION OF THE DRAWINGS FIG. 1 is a diagram showing a relationship between a basic stationary coordinate system and a hand coordinate system of a robot. FIG. 2 is a diagram for explaining a robot control method according to the present invention, and is a diagram illustrating a relationship between a hand end coordinate system and a final actuator coordinate system of the robot. FIG. 3 is a flowchart showing an operation of a robot suitable for the robot control method according to the present invention. [Description of Signs] 1 ... Basic stationary coordinate system, 2 ... Hand coordinate system, 3 ... Final actuator coordinate system, 4, 5, 6, 7, 8, 9 ... Joint, 10 ... Hand,
11 ... Final actuator

Claims (1)

【特許請求の範囲】 １．複数種の最終作用器のうち任意の最終作用器が取付
可能で、最終作用器取付部位又は手先の位置、姿勢に対
してロボット各アクチュエータの回転角に変換し移動さ
せる機能を有するロボットの制御方法において、 前記最終作用器が取り付けられるロボットの最終作用器
取付部位又は手先に対して位置及び姿勢を異にする最終
作用器座標系を各々の最終作用器について定義し、 その定義された各々の最終作用器座標系とロボットの最
終作用器取付部位又は手先の座標系とを相互に一次的に
関係づける位置及び姿勢変換を有する座標系変換マトリ
クスを備え、 前記ロボットの最終作用器取付部位又は手先とロボット
のアクチュエータの回転角を関係づけている座標変換演
算に前記座標系変換マトリクスの演算を加えることによ
り、ロボットを実際の最終作用器取付部位又は手先とは
異なる仮想的に選択された各々の最終作用器座標系に基
づいて与える位置、姿勢の動作命令に対し、ロボットを
動作可能にしたことを特徴とするロボットの制御方法。[Claims] 1. A robot control method in which any final actuator among a plurality of types of final actuators can be attached, and has a function of converting the final actuator attachment site or the position and posture of the hand to the rotation angle of each actuator of the robot and moving the robot. In the final actuator, a final actuator coordinate system having a different position and orientation with respect to the final actuator attachment site or hand of the robot to which the final actuator is attached is defined for each final actuator, and each defined final actuator is defined. The robot has a coordinate system transformation matrix having a position and orientation transformation for temporarily relating the actuator coordinate system and the final actuator attachment site or hand coordinate system of the robot to each other, and the robot's final actuator attachment site or hand. The robot is implemented by adding the coordinate system conversion matrix operation to the coordinate conversion operation relating the rotation angle of the robot actuator. The robot, characterized in that the robot is operable in response to a position and posture operation command given based on each final actuator coordinate system that is virtually different from the final actuator attachment site or the hand of the robot. Control method.