JPH1097315A - Control method for robot - Google Patents
Control method for robotInfo
- Publication number
- JPH1097315A JPH1097315A JP23361097A JP23361097A JPH1097315A JP H1097315 A JPH1097315 A JP H1097315A JP 23361097 A JP23361097 A JP 23361097A JP 23361097 A JP23361097 A JP 23361097A JP H1097315 A JPH1097315 A JP H1097315A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- coordinate system
- final
- actuator
- final actuator
- 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
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
Description
【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は複数種のハンド、ツー
ル、検出器等の最終作用器のうち任意の最終作用器が取
付可能であってその最終作用器が所望の軌道を描くよう
にしたロボットの制御方法に関するものである。
【0002】
【従来の技術】ロボットはその動作が自由に変化できる
点が1つの存在理由となっている。しかしロボットは、
システム的に固有の動作機能をもっておりそれらの組み
合わせにより全体の動作を変化させているのが一般的で
あった。これでは前記固有な動作機能がロボット使用者
にとって不都合な場合、その固有な動作をなさしめるシ
ステム自体を改変する必要があり、実際には不可能であ
ることが殆んどであった。このことは、ロボットに別の
作業、役割をさせる場合についても同様であり、従来の
ロボットは動作上の応用性、拡張性に極めて劣るもので
あった。
【0003】また、従来、IEEE TRANSACT
IONS ON SYSTEMS,MAN, AND
CYBERNETICS, VOL.SMC−11,N
o.4,APRIL 1981 (アイイイー トラン
ザクションズ オン システムズ マン アンド サイ
バネチックス ボリュウム エムエムシ−11 ナンバ
ーヨン エイプリール 1981)(pp.274〜2
89)に記載があるように、ロボットの最終作用器取付
け部位の座標系と最終作用器の座標系に分けてティーチ
ングならびに動作のプログラミングをし、ロボットの動
作経路のポイント−ポイントを上記座標系間の変換を用
いてより簡便にティーチングやプログラミングをできる
ようにしたロボットの制御方法である。
【0004】
【発明が解決しようとする課題】上記従来技術では、ロ
ボットのプレーバック時並びにティーチング時にポイン
ト−ポイントの間の経路補間時に最終作用器の座標系と
最終作用器取付け部位の座標系との間の座標変換を行っ
ていないため、経路補間中の軌道が所望の軌道を通ら
ず、障害物に当たるなどの問題が生じる。
【0005】本発明は上記のような実情に鑑みてなされ
たもので、選択された最終作用器の種類、機能およびロ
ボットへの取付部位に応じて適宜最終作用器座標系が選
択され、最終作用器が所望の軌道を描くようにして動作
機能の応用性、拡張性をもたせたロボットの制御方法を
提供することを目的とする。
【0006】
【課題を解決するための手段】本発明は、従来ロボット
における制御部位を最終作用器取付部位とし、そこに取
り付けられた最終作用器の種類、機能に応じて決定され
る最終作用器座標系、換言すれば最終作用器の位置(姿
勢)を定義し、その定義された各最終作用器の位置とロ
ボットの最終作用器取付部位とを座標系変換マトリック
スで相互に関係づけ、そのマトリックスに基づいてロボ
ットを動作させるようにしたもので、本来ロボットがも
っている動作機能を、ロボット固有の部位ではなくロボ
ットに取り付けられた最終作用器に応じた座標系に対し
てもたせ、これによりロボットの動作機能に応用性、拡
張性をもたせたものである。
【0007】
【実施例】以下、前記座標系変換マトリックスについて
説明する。
【0008】ロボットの基本動作にはロボット各軸のア
クチュエータ単位の移動誤差があるが、ここではその説
明を省略し、高機能ロボットの特徴である手元の直線移
動と姿勢移動動作の補間に関して説明する。すなわち、
高機能ロボットには、これらの位置の移動補間と姿勢の
移動動作の補間が有り、それらの動作機能が基本的に要
求され、従来から何らかの方法でそれを実現している。
【0009】ここでは図1に示すように6軸の自由度を
有するロボットの旋回軸にZ軸をとった直交座標系をロ
ボットのシステム上の基本静止座標系1とする。X
(i)軸、Y(j)軸、Z(k)軸はここでの主方向で
あり、単位ベクトルの成分で表わすと、
X軸(100)
Y軸(010)
Z軸(001)
である。ここで、図1に示すようにロボットの手先10
に同じ様な直交座標系を定義し、これを手先座標系2と
称する。この手先座標系2は前記静止座標系1にと成分表示できる。なお、ロボットの姿勢(位置)を角
度で表わすか単位ベクトルの方向余弦を成分としたマト
リックスで表わすかはロボットのシステムにより任意に
決めて差し支えないが、ここでは方向余弦を成分とした
マトリックスで表わす。
【0010】ここで、位置と方向を合わせて記号化して
マトリックス〔L〕を
と定義すると、ロボットの位置教示はこのマトリックス
〔L〕を求めることに他ならない。すなわち、ロボット
の動作は、このデータであるマトリックス〔L〕の成分
を他のマトリックス〔L〕の成分とで補間し、時間的に
連続に動かして他のマトリックス〔L〕の位置に移動さ
せることであり、ロボットの動作機能は、究極的に前記
補間とどのマトリックス〔L〕の成分を選択的に変化さ
せるかで決
により他の成分を変化させればよい。
【0011】
によればよい。これは他の成分の変化であっても同様で
ある。
【0012】なお、図1において、4〜9はロボットの
関節、θ1〜θ6はそれら関節4〜9の回転角度を示す。
【0013】次に、図2に基づいて本発明方法の具体例
について説明する。図2はロボットの手先座標系と最終
作用器座標系の関数を示す図で、図中3は最終作用器座
標系、11はハンド、ツール、検出器等の最終作用器で
ある。その他は図1と同様であるが、手先10は、ここ
では最終作用器11の取付部位となっている。この図2
において、最終作用器11の位置成分マトリックス
〔Q〕を前述マトリックス〔L〕と同様にしてで表わされる。そしてこの(4)式中のλθ1〜λθ3、
λa1〜λa3、λb1〜λb3およびλc1〜λc3の各定
数を適宜定めることにより手先座標系2とは別の所望の
最終作用器座標系3を定義したことになる。また、
(4)式を整理し、
〕からマトリクス〔L〕を求めることもできる。
【0014】さて、一般に、ロボットの動作機能は手先
座標系2について固有のシステムによって固定化されて
おり、その変更は容易でない。しかし、前記マトリクス
〔L〕とマトリクス〔Q〕は同一性質機能を持つもので
あり、ロボットが持っているマトリクス〔L〕を操作す
る動作機能をそのままマトリクス〔Q〕に適用しても何
ら不都合は生じない。すなわち、図3に示すロボットの
動作機能を実現するフローチャートにおいて、ステップ
103「(4)式の逆行列の実行」を追加するだけで任
意かつ簡単にロボットの動作機能を最終作用器11から
その取付部の座標に変更することが可能となる。(4)
式を無効にし、ロボットの動作機能を手先10側に戻す
には(4)式中の定数を、
λθ1〜λθ3=φ
λa1=λb2=λc3=1
λa2,λa3=λb1,λb3=λc1,λc2=φ
と定めればよい。
【0015】従って、ロボットの制御装置にステップ1
03を実行するブロックを追加すれば、ロボットの動作
機能を任意に変化させることが可能となり応用性、拡張
性のあるロボットが達成できる。
【0016】ここで、一応用例として、ロボットの手先
10を円弧運動させる方法について図2に基づき説明し
ておく。すなわち、ロボットの手先10を点12を中心
に円弧を描かせるには単に点12を前記(4)式中の定
数によってマトリクス〔Q〕
すればよく、他に特別な計算をすることなく簡単に行な
わせることが可能である。
【0017】なお、図3において、100〜104は、
各々図中に記載の動作を実行するステップを指す。
【0018】
【発明の効果】以上述べたように本発明によれば、最終
作用器が取り付けられるロボットの部位に対し、選択さ
れた最終作用器の種類、機能に応じて決定される最終作
用器座標系を定義し、その定義された各最終作用器座標
系とロボットの最終作用器取付部位とを相互に関係づけ
る座標系変換マトリクスを備え、このマトリクスに基づ
いてロボットの運動を支持することにより、プレーバッ
ク時および動作教示時にロボットの最終作用器に対し
て、適した運動を精度良く、容易に提供できる。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 θ 6 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 Λθ 1 to λθ 3 in the equation (4),
By appropriately setting the constants of λa 1 to λa 3 , λb 1 to λb 3, and λc 1 to λc 3 , 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: λθ 1 -λθ 3 = φλa 1 = λb 2 = λc 3 = 1 λa 2 , λa 3 = λb 1 , λb 3 = λc 1 and λc 2 = φ. 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.
【図面の簡単な説明】
【図1】ロボットの基本静止座標系と手先座標系の関係
を示す図である。
【図2】本発明に係るロボットの制御方法を説明するた
めの図であり、ロボットの手先座標系と最終作用器座標
系の関係を示す図である。
【図3】本発明に係るロボットの制御方法を適したロボ
ットの動作を示すフローチャートである。
【符号の説明】
1…基本静止座標系、2…手先座標系、3…最終作用器
座標系、4、5、6、7、8、9…関節、10…手先、
11…最終作用器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.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23361097A JPH1097315A (en) | 1997-08-29 | 1997-08-29 | Control method for robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23361097A JPH1097315A (en) | 1997-08-29 | 1997-08-29 | Control method for robot |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP31507795A Division JP2791302B2 (en) | 1995-12-04 | 1995-12-04 | Robot control method |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH1097315A true JPH1097315A (en) | 1998-04-14 |
Family
ID=16957752
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP23361097A Pending JPH1097315A (en) | 1997-08-29 | 1997-08-29 | Control method for robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH1097315A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9415518B2 (en) | 2013-10-31 | 2016-08-16 | Seiko Epson Corporation | Robot control device and robot |
-
1997
- 1997-08-29 JP JP23361097A patent/JPH1097315A/en active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9415518B2 (en) | 2013-10-31 | 2016-08-16 | Seiko Epson Corporation | Robot control device and robot |
US10150215B2 (en) | 2013-10-31 | 2018-12-11 | Seiko Epson Corporation | Robot control device and robot |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5114019B2 (en) | Method for controlling the trajectory of an effector | |
JPH09265313A (en) | Speed arithmetic device for robot and speed arithmetic method for robot | |
JPS59107884A (en) | Control system of robot | |
JP4263074B2 (en) | Method and apparatus for controlling the operation of a manipulator | |
US20210323152A1 (en) | Global Arm Path Planning with Roadmaps and Precomputed Domains | |
Lippiello et al. | A position-based visual impedance control for robot manipulators | |
JPH1097315A (en) | Control method for robot | |
JP2791302B2 (en) | Robot control method | |
JPH0693209B2 (en) | Robot's circular interpolation attitude control device | |
JPS5927306A (en) | Controlling method of robot | |
JP2680210B2 (en) | Robot control method | |
JPH0193805A (en) | Method for generating teaching data of robot | |
JP2610996B2 (en) | Articulated robot controller | |
JP3904036B2 (en) | Multi-finger multi-joint hand control device | |
JP2001312305A (en) | Tool control method for robot | |
JP2676721B2 (en) | Control device for articulated robot | |
JPS63289606A (en) | Redundancy freedom type robot | |
JPH05177563A (en) | Control method for master slave manipulator | |
JPH06324730A (en) | Controller for industrial robot | |
JPH07299776A (en) | Manipulator control device | |
JPH03111184A (en) | Control unit for robot | |
JP2947417B2 (en) | Robot control method | |
JPH0310781A (en) | Articulated type robot | |
JPH08328628A (en) | Controller for plural robots | |
Krastev | Velocity Motion Path Control of Redundant Robot Arms |