JP5380192B2 - General-purpose robot movement teaching device - Google Patents
General-purpose robot movement teaching device Download PDFInfo
- Publication number
- JP5380192B2 JP5380192B2 JP2009178470A JP2009178470A JP5380192B2 JP 5380192 B2 JP5380192 B2 JP 5380192B2 JP 2009178470 A JP2009178470 A JP 2009178470A JP 2009178470 A JP2009178470 A JP 2009178470A JP 5380192 B2 JP5380192 B2 JP 5380192B2
- Authority
- JP
- Japan
- Prior art keywords
- tube
- robot
- teaching
- axis
- coordinates
- 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.)
- Expired - Fee Related
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Description
本発明は、構成・形状の異なる様々な多関節ロボットに、移動後のハンド、関節の座標・姿勢を教示する汎用教示装置に関するものである。 The present invention relates to a general-purpose teaching apparatus that teaches various articulated robots having different configurations and shapes to indicate the hand and joint coordinates and posture after movement.
ロボットに先端等の座標・姿勢を教示する技術としてはダイレクトティーチ法、ティーチペンダント等の操作盤を用いる方法等があるが、安全で直観的な教示が可能な方法として、マスタースレーブ法に代表されるロボットのダミーを用いて教示する方法がある。 There are direct teach method and teach pendant control panel etc. as techniques to teach robots coordinates and posture of the tip etc., but master slave method is a method that can be taught safely and intuitively. There is a method of teaching using a robot dummy.
ダミーを用いて教示する場合、ロボットとダミーの構造や形状の相違と、ダミーと操作者の構造や形状の相違の双方が問題となる。このため、ダミーの構造や形状はロボットに類似させたものが多く、操作者にとって操作性の良くない構造となっているものも多い。 When teaching using a dummy, both the difference in structure and shape between the robot and the dummy and the difference in structure and shape between the dummy and the operator are problems. For this reason, the dummy structure and shape are often similar to those of a robot, and many have structures that are not easy to operate for the operator.
冗長性のあるロボットに対して、操作者の負担を軽減しつつ、肘座標を教示する発明がある。人間の腕の形状のデータを変換して形状の不一致なダミーに適合させるものであるが、ダミーの構造が固定しているので、多様な構造の様々なロボットへ教示することは困難である（特許文献１）。 There is an invention for teaching elbow coordinates to a redundant robot while reducing the burden on the operator. The human arm shape data is converted to fit the mismatched dummy, but the dummy structure is fixed, so it is difficult to teach various robots with various structures ( Patent Document 1).
又、操作者が相対位置姿勢計測装置を腰に装着し、手に保持した操作グリップとの相対的位置姿勢の変化をセンサで検知してその情報をロボットに教示する発明もある。（特許文献２）。本発明は簡便な装置であるが、ロボットハンド以外の中間関節の座標姿勢を教示することは困難であり、操作グリップの座標を保持し続けることの負担も大きい。 There is also an invention in which an operator wears a relative position / orientation measurement device on his / her waist, detects a change in relative position / orientation with an operation grip held in a hand by a sensor, and teaches the information to the robot. (Patent Document 2). Although the present invention is a simple device, it is difficult to teach the coordinate postures of intermediate joints other than the robot hand, and the burden of maintaining the coordinates of the operation grip is large.
又、本願発明の発明者による紐状のセンサである多関節構造体が提案されている（特許文献３、４）。しかし、これらは多関節構造体の形状の変化や移動量を把握し、多関節構造体自体による機能発揮を目的とするもので、本願発明とは発明の構成、解決しようとする課題が異なる。 Moreover, the multi-joint structure which is a string-like sensor by the inventor of the present invention has been proposed (Patent Documents 3 and 4). However, these are for the purpose of grasping the shape change and movement amount of the multi-joint structure and exhibiting the function of the multi-joint structure itself, and the configuration of the invention and the problem to be solved are different from the present invention.
又、操作者がマスターアームに自由度８以上の紐状センサを用いて操作するマニピュレータシステムが提案されている（特許文献５）。しかし、当発明は、操作者が搬送コンベア上の小物ワーク等を挟んで紐状センサを含むマスターの取り付け部と対向した位置で当該センサを操作し、マスターに対応するスレーブを追随移動させるものである。又、その効果は、対向する位置から操作するのでセンサが操作の邪魔にならないというものである。したがって、基本的にマスターは対応するスレーブ専用の装置で、形状・構造はスレーブと類似にならざるを得ない。多様なロボットに対する広汎な教示装置として、離れた位置から、場合により移動しながら教示するというものではない。 In addition, a manipulator system in which an operator operates a master arm using a string sensor having a degree of freedom of 8 or more has been proposed (Patent Document 5). However, according to the present invention, the operator operates the sensor at a position facing the master mounting portion including the string-shaped sensor across a small work or the like on the transport conveyor, and moves the slave corresponding to the master following. is there. The effect is that the sensor does not interfere with the operation because the operation is performed from the opposite position. Therefore, the master is basically a device dedicated to the corresponding slave, and the shape and structure must be similar to the slave. As an extensive teaching apparatus for various robots, teaching is not performed while moving from a remote position in some cases.
本発明は、これらの問題点に鑑みてなされたものである。関節数、関節機能、関節間長等構成・形状の異なる様々なロボットに対して広汎にハンド・関節の移動後の座標・姿勢を教示することができ、かつ、操作者の熟練度、体型等の要素に影響なく、直観的かつ簡易に操作が可能な装置の提供を目的とする。 The present invention has been made in view of these problems. Coordinates / postures after hand / joint movement can be taught extensively to various robots with different configurations / shapes such as the number of joints, joint functions, joint lengths, etc. It is an object of the present invention to provide an apparatus that can be operated intuitively and easily without affecting the above factors.
かかる課題を解決するために、
フレキシブルセンサチューブと該フレキシブルセンサチューブの一端が固着されている情報教示部から成り、
上記フレキシブルセンサチューブは、可動部を有するチューブが多数連なるチューブ群と隣接するチューブ間の角度を検出するセンサと検出した角度データを伝送する通信部により構成され、
上記情報教示部は、上記伝送された角度データを演算処理する演算部と処理された座標姿勢情報を出力する出力部により構成される
ロボット移動教示装置において、
上記チューブ群が、少なくともＸ軸又はＹ軸方向への屈曲が可能な、上記可動部を有する多数のチューブ、並びに少なくともＺ軸を中心とした回転が可能な、複数のチューブにより構成され、
かつ、上記フレキシブルセンサチューブの変形に伴う変形後の隣接するチューブ間のＸ軸及びＹ軸方向への屈曲並びにＺ軸を中心とした回転による角度を計測し、順運動学に基づいて１又は複数の特定の上記チューブについて、変形後の座標及び/又は姿勢を算出し、
対応する１又は複数の特定の部分についての移動後の座標及び/又は姿勢を教示することにより
教示対象ロボットに追随移動させることを特徴とするロボット移動教示装置が提供される。
To solve this problem,
A flexible sensor tube and an information teaching unit to which one end of the flexible sensor tube is fixed,
The flexible sensor tube is composed of a sensor that detects an angle between a tube group having a plurality of tubes having a movable part and an adjacent tube, and a communication unit that transmits detected angle data.
In the robot movement teaching apparatus, the information teaching unit includes an arithmetic unit that performs arithmetic processing on the transmitted angle data and an output unit that outputs processed coordinate posture information.
The tube group is composed of a plurality of tubes having the movable part capable of bending at least in the X-axis or Y-axis direction, and a plurality of tubes capable of rotating around at least the Z-axis,
In addition, one or a plurality of angles based on forward kinematics are measured based on forward kinematics by measuring the angle between the X- and Y-axis bends between the adjacent tubes after the deformation of the flexible sensor tube and the rotation about the Z-axis. Calculate the coordinates and / or posture after deformation for the specific tube
There is provided a robot movement teaching apparatus characterized by causing a robot to be taught to follow and move by teaching coordinates and / or postures after movement of corresponding one or more specific parts.
又、フレキシブルセンサチューブと該フレキシブルセンサチューブの一端が固着されている情報教示部から成り、
上記フレキシブルセンサチューブは、可動部を有するチューブが多数連なるチューブ群と隣接するチューブ間の角度を検出するセンサと検出した角度データを伝送する通信部により構成され、
上記情報教示部は、上記伝送された角度データを演算処理する演算部と処理された座標姿勢情報を出力する出力部により構成される
ロボット移動教示装置において、
上記チューブ群が、少なくともＸ軸又はＹ軸方向への屈曲が可能な、上記可動部を有する多数のチューブ、並びに少なくともＺ軸を中心とした回転が可能な、複数のチューブにより構成され、
かつ、上記フレキシブルセンサチューブの変形に伴う変形後の隣接するチューブ間のＸ軸及びＹ軸方向への屈曲並びにＺ軸を中心とした回転による角度を計測し、順運動学に基づいて特定の上記チューブについて、変形後の座標及び/又は姿勢を算出し、
逆運動学に基づいて対応する複数の特定の部分についての移動後の座標及び/又は姿勢を教示することにより
教示対象ロボットに追随移動させることを特徴とするロボット作業教示装置が提供される。
In addition, the flexible sensor tube and an information teaching unit to which one end of the flexible sensor tube is fixed,
The flexible sensor tube is composed of a sensor that detects an angle between a tube group having a plurality of tubes having a movable part and an adjacent tube, and a communication unit that transmits detected angle data.
In the robot movement teaching apparatus, the information teaching unit includes an arithmetic unit that performs arithmetic processing on the transmitted angle data and an output unit that outputs processed coordinate posture information.
The tube group is composed of a plurality of tubes having the movable part capable of bending at least in the X-axis or Y-axis direction, and a plurality of tubes capable of rotating around at least the Z-axis,
And the angle by the bending | flexion to the X-axis and the Y-axis direction between the adjacent tubes after a deformation | transformation with the deformation | transformation of the said flexible sensor tube, and rotation centering on a Z-axis is measured, and the above-mentioned specific based on forward kinematics For the tube, calculate the coordinates and / or posture after deformation,
There is provided a robot operation teaching apparatus characterized by causing a robot to be taught to follow by teaching coordinates and / or postures after movement of a plurality of corresponding specific parts based on inverse kinematics.
又、上記フレキシブルセンサチューブにおける終端チューブの上記変形後の座標及び姿勢に基づいて、教示対象ロボットの移動後の中間可動部分の座標を算出することを特徴とする請求項１に記載のロボット移動教示装置が提供される。 2. The robot movement teaching according to claim 1, wherein coordinates of the intermediate movable part after movement of the teaching target robot are calculated based on the coordinates and posture of the terminal tube of the flexible sensor tube after the deformation. An apparatus is provided.
又、上記座標及び/又は姿勢を算出する対象のチューブを終端チューブ及び教示対象ロボットの中間可動部分に対応する位置にある中間チューブとすることを特徴とするロボット移動教示装置が提供される。 Further, there is provided a robot movement teaching device characterized in that the target tube for calculating the coordinates and / or posture is an end tube and an intermediate tube at a position corresponding to the intermediate movable part of the teaching target robot.
又、算出された終端チューブの上記座標及び/又は姿勢の情報をそのまま保持しつつ、上記座標及び/又は姿勢を新たに算出する対象のチューブを教示対象ロボットの中間可動部分に対応する位置にある中間チューブのみとすることを特徴とするロボット移動教示装置が提供される。 Further, while maintaining the calculated coordinates and / or posture information of the terminal tube as it is, the tube whose coordinates and / or posture are newly calculated is in a position corresponding to the intermediate movable part of the teaching target robot. There is provided a robot movement teaching device characterized by having only an intermediate tube.
又、上記ロボット移動教示装置がさらに外部入力手段を有し、少なくとも教示対象ロボットの関節数、各関節の軸回転機能及び各関節間の長さデータのいずれか又はすべてを入力し、かつ該データの処理をすることにより、教示対象ロボットのハンド及び/又は各関節についての移動後の座標及び/又は姿勢を教示することを特徴とするロボット移動教示装置が提供される。 The robot movement teaching device further includes an external input means for inputting at least one of the number of joints of the teaching target robot, the axis rotation function of each joint, and the length data between the joints, and the data. By performing the above process, a robot movement teaching apparatus is provided that teaches the coordinates and / or postures after movement of the hand and / or each joint of the teaching target robot.
又、上記ロボット移動教示装置がさらに教示対象ロボットとの接続手段を有し、該接続手段を通じて、少なくとも教示対象ロボットの関節数、各関節の機能及び各関節間の長さデータのいずれか又はすべてを自動取得することを特徴とするロボット移動教示装置が提供される。 In addition, the robot movement teaching apparatus further includes a connection means with the teaching target robot, and at least one or all of the number of joints of the teaching target robot, the function of each joint, and the length data between the joints through the connection means. There is provided a robot movement teaching apparatus characterized by automatically acquiring.
又、上述のロボット移動教示装置を人間に装着し、装着した人間の動作に基づいて上記教示対象ロボットの１又は複数の部分についての移動後の座標及び/又は姿勢を教示する場合において、人間の可動部分に固定された特定のチューブのみについて、上記変形後の座標及び/又は姿勢を算出することを特徴とするロボット移動教示装置が提供される。 In addition, when the robot movement teaching device described above is attached to a human and the coordinates and / or posture after movement of one or more parts of the teaching target robot are taught based on the movement of the human being attached, There is provided a robot movement teaching apparatus characterized by calculating the coordinates and / or posture after the deformation for only a specific tube fixed to a movable part.
又、上記ロボット移動教示装置において、チューブ群全体として人間の関節が有する軸の機能と同一の機能を有することを特徴とするロボット移動教示装置が提供される。 In the robot movement teaching apparatus, there is provided a robot movement teaching apparatus characterized in that the tube group as a whole has the same function as the axis of a human joint.
又、特定のチューブを人間の可動部分に固定する場合において、位置調整が可能な固定手段を有することを特徴とするロボット移動教示装置が提供される。 Further, there is provided a robot movement teaching device characterized by having a fixing means capable of adjusting the position when a specific tube is fixed to a human movable part.
又、上記ロボット移動教示装置において、人間の手首、肘及び肩に固定された特定のチューブについて、上記変形後の座標及び/又は姿勢を算出することを特徴とするロボット移動教示装置が提供される。 Further, in the robot movement teaching apparatus, there is provided a robot movement teaching apparatus characterized in that the coordinates and / or posture after the deformation are calculated for a specific tube fixed to a human wrist, elbow and shoulder. .
又、上記ロボット移動教示装置を人間に装着する場合において、さらに基準原点自体の座標及び/又は姿勢の変動を計測する手段を備えたことを特徴とするロボット移動教示装置が提供される。 In addition, when the robot movement teaching apparatus is mounted on a human, a robot movement teaching apparatus is provided that further includes means for measuring a change in coordinates and / or posture of the reference origin itself.
又、上述のロボット移動教示装置がさらにロボット本体の駆動電源又は主制御メイク信号の開閉手段を有し、前記開閉手段をＯＦＦにするとロボットの動作が非常停止することを特徴とするロボット移動教示装置が提供される。 Further, the robot movement teaching apparatus described above further has an opening / closing means for driving power of the robot body or a main control make signal, and the robot operation is emergency stopped when the opening / closing means is turned off. Is provided.
又、上記開閉手段はデッドマンスイッチであることが好ましい。 The opening / closing means is preferably a deadman switch.
又、上記フレキシブルセンサチューブを構成する可動部を有する各チューブが、Ｘ軸方向への屈曲、Ｙ軸方向への屈曲又はＺ軸を中心とした回転のいずれかのみが可能な上記チューブであることを特徴とするロボット移動教示装置が提供される。 Each tube having a movable part constituting the flexible sensor tube is a tube that can be bent only in the X-axis direction, bent in the Y-axis direction, or rotated around the Z-axis. A robot movement teaching device is provided.
又、上記フレキシブルセンサチューブを構成する可動部を有する各チューブが、同一の長さであり、かつ、可動方向が異なる上記可動部を有するチューブが交互に配置されていることを特徴とするロボット移動教示装置が提供される。 In addition, each of the tubes having movable parts constituting the flexible sensor tube has the same length, and the tubes having the movable parts having different movable directions are alternately arranged. A teaching device is provided.
本発明に係るフレキシブルセンサチューブ（以下、「ＦＳＴ」という。）は多数の可動部を有するチューブ群より成り、多数の自由度を有するので、４軸、６軸、７軸あるいはそれ以上の多関節ロボットに対しても移動後の座標及び姿勢を適切に教示することができる汎用性を有する。従来型の教示対象ロボットと類似形状を有する教示装置においては、総関節数、各関節ごとの軸の機能、アームの長さやアーム長さのバランス等をロボットと類似させるので、総関節数や関節ごとの軸の機能の配分が異なる等の他のタイプのロボットに教示することが困難であった。類似するタイプのロボットには適切に移動先を教示できても、より自由度の多い他のタイプのロボットに教示すべき移動先は教示装置の可動範囲の死角となり適切に教示できないという不具合が生じる場合もあった。この点、本発明に係るロボット移動教示装置（以下、「ＦＳＴ教示装置」という。）は全体的にむちのように柔軟に形状を変化させることができるので、どのようなタイプのロボットに対しても教示可能な汎用性を有する。なお、関節の軸の機能とは、回転方向が単一か複数か、どの方向に対する回転が可能かという関節が有する属性をいう。 The flexible sensor tube (hereinafter referred to as “FST”) according to the present invention is composed of a tube group having a large number of movable parts and has a large number of degrees of freedom, so that it is a multi-joint having four axes, six axes, seven axes or more. The robot is versatile enough to properly teach the coordinates and posture after movement. In a teaching device having a similar shape to a conventional teaching target robot, the total number of joints, the function of the axis for each joint, the length of the arm and the balance of the arm length, and the like are similar to the robot. It was difficult to teach other types of robots, such as the distribution of the function of each axis being different. Even if a similar type robot can be properly taught the destination, the destination that should be taught to other types of robots with more freedom is a blind spot in the range of movement of the teaching device, causing a problem that it cannot be taught properly. There was a case. In this respect, the robot movement teaching device (hereinafter referred to as “FST teaching device”) according to the present invention can change its shape flexibly like a whip as a whole, so that it can be applied to any type of robot. Has versatility that can be taught. The function of the axis of the joint refers to an attribute of the joint that indicates whether the rotation direction is single or plural and in which direction the rotation is possible.
本発明に係るＦＳＴを構成する特定のチューブの座標及び姿勢を計測することにより、多関節ロボットのハンドや任意の関節に対して移動後の座標及び姿勢を教示することができる。例えば、情報教示部に固着しているＦＳＴの始端チューブからＦＳＴ全体の先端に位置する終端チューブまでに番号を付して、教示対象ロボットの関節部分に対応する番号のチューブを特定チューブとして、その座標及び姿勢を計測することも可能である。ＦＳＴは多数の可動部を有するチューブによる多数の座標・姿勢情報を取得しうるが、取得しうるすべての情報を常に取得するのではなく、必要に応じて、選択された可動部を有するチューブの情報のみを取得する。ＦＳＴを構成するすべてのチューブについて、座標及び姿勢を計測することが可能なので、教示対象ロボットのどの位置のどの関節に対しても、移動後の座標及び姿勢を教示することができる。なお、本発明においてロボットとは主に多関節ロボットを指すが、歩行ロボットや人間・動物の動作に類似した動作を行うロボットを含む。又、ハンドとはグリッパに限定されず、回転等様々な機能を含む端末部分をいう。 By measuring the coordinates and posture of a specific tube constituting the FST according to the present invention, it is possible to teach the coordinates and posture after movement to the hand of an articulated robot or an arbitrary joint. For example, a number is assigned from the start tube of the FST fixed to the information teaching unit to the end tube located at the tip of the entire FST, and the tube with the number corresponding to the joint portion of the robot to be taught is designated as the specific tube. It is also possible to measure the coordinates and orientation. The FST can acquire a large number of coordinate / posture information from a tube having a large number of movable parts, but does not always acquire all the information that can be acquired. Get information only. Since coordinates and postures can be measured for all tubes constituting the FST, coordinates and postures after movement can be taught to any joint at any position of the teaching target robot. In the present invention, the robot mainly refers to an articulated robot, but includes a walking robot and a robot that performs an operation similar to that of a human / animal. The hand is not limited to the gripper, but refers to a terminal portion including various functions such as rotation.
本発明に係るＦＳＴの変形は、隣接する関節間の角度変化のみを計測することにより把握するので構造がシンプルである一方、多数のチューブにより構成されるので全体としては自由度が多い。シンプルかつ多自由度という特徴を有する。ここで、本発明に係るＦＳＴのＸ軸又はＹ軸方向への屈曲が可能なチューブが多数とは、それらが少なくとも３のチューブを有することをいい、Ｚ軸を中心とした回転が可能な複数のチューブと合わせて、人間の腕に対応する自由度に近いか又はそれ以上の自由度を確保している。なお、Ｚ軸を中心とした回転が可能なチューブを、Ｘ軸又はＹ軸方向への屈曲が可能なチューブの数とバランスさせた多数とすることがより好ましい。 Since the deformation of the FST according to the present invention is grasped by measuring only the angle change between adjacent joints, the structure is simple. On the other hand, the FST is composed of a large number of tubes, and thus has a high degree of freedom as a whole. It has the characteristics of simple and multiple degrees of freedom. Here, a large number of tubes that can be bent in the X-axis or Y-axis direction of the FST according to the present invention means that they have at least three tubes, and a plurality of tubes that can rotate around the Z-axis. In combination with the tube, the degree of freedom corresponding to or higher than that of the human arm is secured. More preferably, the number of tubes that can rotate around the Z axis is balanced with the number of tubes that can be bent in the X-axis or Y-axis direction.
又、順運動学に基づいて終端チューブ等の位置及び姿勢情報を取得した後に、当該情報に基づいて逆運動学により中間可動部等の位置及び姿勢を求め、複数の位置及び姿勢情報を教示対象ロボットに教示することができる。 In addition, after acquiring the position and orientation information of the end tube etc. based on forward kinematics, the position and orientation of the intermediate movable part etc. are obtained by inverse kinematics based on this information, and multiple position and orientation information are taught The robot can be taught.
又、教示対象ロボットにハンド部分の座標及び姿勢を教示した場合、教示対象ロボットはハンド部分の座標を満足するための中間可動部分の関節座標を一意に決定できない場合があるが、本発明に係る終端チューブの座標と姿勢を基準として、教示対象ロボットの関節座標を一意に決定することができる。なお、本発明において、終端チューブとはＦＳＴの最先端のチューブをいい、始端チューブとはＦＳＴの根元部分の情報教示部と固着しているチューブをいう。 Further, when the teaching target robot is taught the coordinates and orientation of the hand part, the teaching target robot may not be able to uniquely determine the joint coordinates of the intermediate movable part to satisfy the coordinates of the hand part. The joint coordinates of the teaching target robot can be uniquely determined based on the coordinates and posture of the end tube. In the present invention, the end tube refers to the most advanced tube of the FST, and the start tube refers to the tube that is fixed to the information teaching portion at the base of the FST.
又、終端チューブと教示ロボットの中間可動部分（関節）の位置に相当する位置にあるチューブの複数の座標及び/又は姿勢を計測することによっても、教示対象ロボットのハンド及び中間可動部分（関節）の座標及び/又は姿勢を一意に教示することができる。 Further, by measuring a plurality of coordinates and / or postures of the tube at a position corresponding to the position of the terminal tube and the intermediate movable part (joint) of the teaching robot, the hand of the teaching target robot and the intermediate movable part (joint) are also measured. Can be uniquely taught.
又、教示対象ロボットが作業中等の場合において、ハンド座標を保持しつつ肘部分等中間関節が障害物を回避する必要がある場合には、教示ロボットの中間可動部分（関節）の位置に相当する位置にある中間チューブのみを移動させる変形を行うことにより可能となる。 Also, when the teaching target robot is working, etc., if the intermediate joint such as the elbow part needs to avoid an obstacle while holding the hand coordinates, it corresponds to the position of the intermediate movable part (joint) of the teaching robot. This is made possible by performing a deformation in which only the intermediate tube in position is moved.
又、外部入力手段により、教示対象ロボットの関節数、関節の機能、関節間長の情報を獲得した場合、教示対象ロボットにきっちり適合した、ハンド及び関節の座標及び/又は姿勢を教示することができる。ＦＳＴ教示装置の演算部において、ＦＳＴチューブの座標及び姿勢を計測すると共に、外部入力手段による情報を条件として演算することにより、教示対象ロボットのハンド座標及び姿勢と、それを満たす中間関節の関節角度を適切に決定することができるのである。すなわち、ＦＳＴ教示装置の演算部は教示対象ロボットの軸角度（位置）コントローラの機能も有することになる。したがって、教示対象ロボットの省機能、省スペースが可能になる。なお、ＦＳＴ教示装置の座標系と教示対象ロボットの座標系の座標変換情報を取得することが好ましい。 In addition, when the number of joints of the teaching target robot, the function of the joint, and the length of the joint length are acquired by the external input means, the coordinates and / or postures of the hand and the joint that are exactly matched to the teaching target robot can be taught. it can. In the calculation unit of the FST teaching device, the coordinates and posture of the FST tube are measured, and the calculation is performed on the condition of the information from the external input means. Can be determined appropriately. That is, the calculation unit of the FST teaching apparatus also has a function of an axis angle (position) controller of the teaching target robot. Therefore, it is possible to save functions and space of the teaching target robot. Note that it is preferable to acquire coordinate conversion information between the coordinate system of the FST teaching apparatus and the coordinate system of the teaching target robot.
又、教示対象ロボットの上記情報を自動取得することにより入力作業が不要となる。１基のＦＳＴ教示装置でタイプの異なるロボットに次々と移動教示を行うことが可能となる。又、同時に軸数等の異なる複数のロボットに同時に教示することもできる。 Further, by automatically acquiring the above information of the teaching target robot, no input work is required. One FST teaching device can sequentially teach movement to different types of robots. It is also possible to teach a plurality of robots having different numbers of axes at the same time.
ＦＳＴ教示装置を人間に装着して、人間の可動部、すなわち、手首、肘、肩、腰、膝、足首等にＦＳＴの対応する特定チューブを固定することにより、ＦＳＴの変形を介してロボットにハンドや中間関節の座標及び姿勢を教示することができる。マスタースレーブ法等においては、教示対象ロボットの肘等中間関節に対応すると思われる部分を推測して操作する場合は、中間関節に対応する本来の教示すべき部分と、推測によって特定する部分とに誤差が生じる場合があるが、上記により、ＦＳＴ教示装置における教示すべきチューブの特定は極めて短時間に、かつ正確に行うことができる。又、ＦＳＴのチューブ群全体の長さにゆとりを持たせることで、装着する人間の体型や体の大きさに関係なく、特定のチューブを、常に可動部に固定するチューブとして特定することも可能である。たとえば、体の大きな者に装着した場合はチューブ群のたるみを小さく、又、子供や女性など体の小さな者に装着した場合はたるみを大きくすることにより、肘位置専用チューブ、手首位置専用チューブ等を決定することも可能である。この場合、座標及び姿勢を計測するチューブを都度特定する作業を省略することが可能である。なお、ＦＳＴのチューブ全体を使わず、中間チューブを終端チューブと見立てることによっても体型や体の大きさに適合させることもできる。 The FST teaching device is attached to a human, and a specific tube corresponding to the FST is fixed to the movable part of the human, that is, the wrist, elbow, shoulder, waist, knee, ankle, etc. The coordinates and postures of the hand and the intermediate joint can be taught. In the master-slave method, etc., when estimating and operating a part that seems to correspond to the intermediate joint such as the elbow of the robot to be taught, the original part to be taught corresponding to the intermediate joint and the part specified by estimation Although an error may occur, the tube to be taught in the FST teaching apparatus can be specified in a very short time and accurately. In addition, by giving the overall length of the FST tube group a certain length, it is possible to specify a specific tube as a tube that is always fixed to the movable part, regardless of the body shape or size of the person wearing it. It is. For example, a tube group dedicated to elbow position, a wrist position dedicated tube, etc. by reducing the slack of the tube group when worn on a large body, and increasing the slack when worn on a small body such as a child or a woman. It is also possible to determine. In this case, it is possible to omit the work of specifying the tube for measuring the coordinates and orientation each time. It is also possible to adapt to the body shape and body size by using the intermediate tube as a terminal tube without using the entire FST tube.
ＦＳＴ教示装置の機能を人間の関節の機能と一致させることで、装着者の意図する動作をより適切に計測して教示することができる。本発明に係るチューブ群は短いチューブが多数連なっているので、腕、脚など諸々の部位に対応することができる。ＦＳＴ教示装置における特定の軸回転の方向（Ｘ軸又はＹ軸方向への屈曲、Ｚ軸を中心とした回転）を有するチューブのＦＳＴ全体中における配置は、人間における特定の軸回転の方向を有する関節の腕等の全体中における配置と同じであることがより好ましい。さらに具体的には、Ｚ軸を中心とした回転を有するチューブを少なくとも２つ有し、そのうちの１つは、人間の肩関節を中心とした回転関節機能に一致させるよう配置し、さらにそのうちの一つは、人間の肘関節を中心とした回転関節機能に一致させるよう配置することが好ましい。 By matching the function of the FST teaching device with the function of a human joint, the operation intended by the wearer can be measured and taught more appropriately. Since the tube group according to the present invention has a large number of short tubes, it can correspond to various parts such as arms and legs. The arrangement of the tubes in the entire FST having a specific direction of rotation (bending in the X-axis or Y-axis direction, rotation about the Z-axis) in the FST teaching device has a specific direction of rotation in humans. More preferably, it is the same as the arrangement of the joint arms and the like throughout. More specifically, it has at least two tubes having rotation about the Z axis, one of which is arranged to match the function of the rotation joint about the human shoulder joint, One is preferably arranged so as to match the rotational joint function around the human elbow joint.
上記人間の可動部に、固定位置を調整できるような上記チューブの固定手段を有することで、装着者間の関節部間の絶対的長さ、相対的長さバランスが異なっても、容易に装着者に適合した固定位置に変更することができる。固定位置の調整としては、チューブに接続した柔軟性のある素材のバンドを操作者の腕に巻く方法が考えられるが、特に限定されるものではない。 Equipped with the tube fixing means that can adjust the fixed position on the movable part of the human, so that even if the absolute length and relative length balance between the joints between the wearers are different, they can be easily attached. It can be changed to a fixed position suitable for the person. As the adjustment of the fixing position, a method of winding a flexible material band connected to the tube around the arm of the operator is conceivable, but it is not particularly limited.
又、アームロボット等に移動教示する場合には、通常は人間の手首及び肘の座標及び姿勢が問題となる。しかし、人間が腕を伸ばす場合には肩の座標も変化する一方、ロボットは肩の座標が変化しない。したがって、ＦＳＴの始端チューブを起点とする肩の移動もＦＳＴ形状の変化として把握することにより、ロボットに、より適切な座標を教示できる。 Also, when teaching movement to an arm robot or the like, the coordinates and posture of a human wrist and elbow are usually problematic. However, when a human stretches his arm, the coordinates of the shoulder change, while the robot does not change the coordinates of the shoulder. Therefore, by grasping the movement of the shoulder starting from the start tube of the FST as a change in the FST shape, more appropriate coordinates can be taught to the robot.
又、ロボットに移動教示する場合にＦＳＴマスター（情報教示部）自体の移動、姿勢を計測することにより。無意識な体勢の変化等に影響されずに適切な教示を行うことができる。なお、基準原点とはＦＳＴの変形を計測する上での基準点を言う。通常はＦＳＴマスター（情報教示部）と固着している始端チューブが基準原点に該当するが、必ずしも限定されるものではない。 Also, by measuring the movement and posture of the FST master (information teaching unit) itself when teaching the robot to move. Appropriate teaching can be performed without being influenced by unconscious changes in posture. The reference origin is a reference point for measuring the deformation of the FST. Normally, the start tube fixed to the FST master (information teaching unit) corresponds to the reference origin, but is not necessarily limited.
安全上の要請から、教示対象ロボットの駆動を緊急に停止する必要が生じる場合がある。ＦＳＴ教示装置にロボットの駆動電源又は主制御メイク信号の非常停止手段を備えることにより、ロボット教示作業中の安全性を担保できる。 Due to safety requirements, it may be necessary to urgently stop driving the teaching target robot. By providing the FST teaching device with the robot drive power supply or the emergency stop means of the main control make signal, the safety during the robot teaching operation can be ensured.
上記開閉手段がデッドマンスイッチであれば適切に停止動作を実行することができる。デッドマンスイッチを握るとロボットのサーボ電源等がＯＮとない、離すとＯＦＦになることで素早く非常停止を実行することが可能である。又、３ポジションのデッドマンスイッチを採用することによって、適度な力でデッドマンスイッチを握るとＯＮになり。離したり、緊張して強く握りしめたりした場合にはＯＦＦとなるので、確実に非常停止を行うことができる。 If the opening / closing means is a deadman switch, the stop operation can be appropriately executed. When the deadman switch is gripped, the robot servo power supply or the like is not ON, and when it is released, the emergency stop can be executed quickly. Also, by adopting a 3-position deadman switch, it will be turned on when the deadman switch is gripped with an appropriate force. Since it is turned off when it is released or when it is tightly squeezed, it can be surely made an emergency stop.
ＦＳＴを構成するチューブの回転機能をＸ軸、Ｙ軸、Ｚ軸のいずれかに関するものに限定し、チューブの数を多数とすることにより、多数の自由度を保持しつつ、簡易な構造かつ計測が容易な教示装置の提供が可能となる。 By limiting the rotation function of the tube that constitutes the FST to one of the X-axis, Y-axis, and Z-axis, and by increasing the number of tubes, a simple structure and measurement while maintaining a large number of degrees of freedom. Can be provided.
チューブ長を一定とすると、構造が簡易なり、かつ、Ｘ軸又はＹ軸方向への屈折の場合は隣接するチューブは常に２等辺三角形を形成するので距離計測が容易になる。さらに、可動方向が異なる上記可動部を有するチューブが交互に配置されることにより、ＦＳＴ全体がバランスのとれた死角のない柔軟性の高い変形が可能となる。 If the tube length is constant, the structure is simple, and in the case of refraction in the X-axis or Y-axis direction, the adjacent tubes always form isosceles triangles, so distance measurement is easy. Furthermore, by alternately arranging the tubes having the movable parts having different movable directions, the FST as a whole can be deformed with high flexibility without a blind spot in which the entire FST is balanced.
以下、本発明の実施例について、図面を参照しながら詳細に説明していく。 Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.
図１はＦＳＴ教示装置と教示対象ロボットの全体概念図である。ＦＳＴ教示装置０５はフレキシブルセンサチューブ（ＦＳＴ）１０とＦＳＴマスター（情報教示部）１８により構成される。教示対象ロボット２０は７軸ロボットで、アーム２１、屈曲関節２２、軸回転関節２３ハンド２６、コントローラ３０、ドライバ４０、図示しない減速機、モータ等により構成される。なお既述の通り、教示対象ロボットは関節数に限定されないので４軸、６軸等であっても良く、又、全体における関節の構成・配置についても限定されない。 FIG. 1 is an overall conceptual diagram of an FST teaching apparatus and a teaching target robot. The FST teaching device 05 includes a flexible sensor tube (FST) 10 and an FST master (information teaching unit) 18. The teaching target robot 20 is a seven-axis robot, and includes an arm 21, a bending joint 22, a shaft rotation joint 23, a hand 26, a controller 30, a driver 40, a reduction gear (not shown), a motor, and the like. As described above, the teaching target robot is not limited to the number of joints, and may be four axes, six axes, or the like, and the configuration and arrangement of joints in the whole is not limited.
次に、図２に基づいてＦＳＴ１０の説明をする。１１は可動部を有するチューブ、１３は Ｘ軸方向への屈曲が可能な可動部、１４はＹ軸方向への屈曲が可能な可動部、１５はＺ軸を中心とした回転が可能な可動部である。ここで、Ｘ軸方向への屈曲が可能とはチューブの長手方向に対して、チューブが左右方向へ回転（垂直軸を中心とした回転）することが可能であることをいう。屈曲範囲は左右各々４５度程度であるが、その範囲に限定されるものではない。Ｙ軸方向への屈曲が可能とは、同様にチューブの長手方向に対して、チューブが上下方向へ回転（チューブ長手方向と直角の水平軸を中心とした回転）することが可能であることをいう。 Next, the FST 10 will be described with reference to FIG. 11 is a tube having a movable part, 13 is a movable part that can be bent in the X-axis direction, 14 is a movable part that can be bent in the Y-axis direction, and 15 is a movable part that can rotate around the Z-axis. It is. Here, being able to bend in the X-axis direction means that the tube can be rotated in the left-right direction (rotation about the vertical axis) with respect to the longitudinal direction of the tube. The bending range is about 45 degrees on each of the left and right sides, but is not limited to that range. Similarly, being able to bend in the Y-axis direction means that the tube can be rotated in the vertical direction with respect to the longitudinal direction of the tube (rotation about a horizontal axis perpendicular to the longitudinal direction of the tube). Say.
又、Ｚ軸を中心とした回転が可能とは、チューブの長手方向を軸としてその軸を中心にチューブが回転することをいう。なお、Ｘ軸方向への屈曲とＹ軸方向への屈曲の差は相対的なものであり、Ｚ軸を中心とした回転により９０度回転するとＸ軸方向への屈曲とＹ軸方向への屈曲は入れ替わる。したがって、本発明に係るＦＳＴのチューブの構成としては、Ｘ可動部チューブ＋Ｙ可動部チューブ＋Ｚ可動部チューブでも、Ｘ可動部チューブ＋Ｚ可動部チューブでもＹ可動部チューブ＋Ｚ可動部チューブでも良い。Ｘ可動部チューブ、Ｙ可動部チューブ又はＺ可動部チューブの屈曲又は回転は、ＦＳＴ全体としては形状の変形として把握される。 In addition, being able to rotate about the Z axis means that the tube rotates about the axis with the longitudinal direction of the tube as the axis. Note that the difference between the bend in the X-axis direction and the bend in the Y-axis direction is relative, and when rotated 90 degrees by rotation about the Z-axis, the bend in the X-axis direction and the bend in the Y-axis direction Will be replaced. Therefore, the configuration of the FST tube according to the present invention may be an X movable portion tube + Y movable portion tube + Z movable portion tube, X movable portion tube + Z movable portion tube, Y movable portion tube + Z movable portion tube. The bending or rotation of the X movable part tube, the Y movable part tube, or the Z movable part tube is grasped as a deformation of the shape of the entire FST.
図２に係るＦＳＴには、可動部を有しない終端チューブ１２とチューブ間の角度を計測するポテンショメータ１６とポテンショメータで計測したデータを演算し伝送するＣＰＵ１７が含まれる。 The FST according to FIG. 2 includes a terminal tube 12 having no movable part, a potentiometer 16 that measures an angle between the tubes, and a CPU 17 that calculates and transmits data measured by the potentiometer.
終端チューブは可動部を有するタイプであっても構わないが、可動部を有さないタイプの場合は屈曲又は回転しないチューブ長を大きく取ることができ、終端関節を把持して移動させる場合の操作安定性が増す。先端部に可動部を有さないチューブを複数連ねた場合はさらにふらつきのない安定した操作が可能である。 The end tube may be of a type having a movable part, but in the case of a type having no movable part, the tube length that does not bend or rotate can be made large, and the operation for gripping and moving the terminal joint Increased stability. When a plurality of tubes having no movable part are connected at the tip, a stable operation without further wobbling is possible.
ポテンショメータに限らすエンコーダ、圧電素子、光センサ等他の曲げ検知センサを用いても良いが、多数のチューブを有する本発明に係る装置故に簡易な検知センサが好ましい。ポテンショメータで検出されたチューブ間の角度の数値は、データ化され、数個のデータが近接したＣＰＵに送信・集積される。本実施例に係るＣＰＵはＣＡＮ通信機能を有しており、本ＦＳＴ全体で１つのＣＡＮネットワークが構築されているので、すべてのＣＰＵから集積されたデータがＦＳＴマスター１８内の演算部に直接送信される。もちろん、いくつかのＣＰＵのデータをさらに１グループとしてグループ単位で集計し、集計されたデータを送信するようにしても良い。ＦＳＴ内の送信及びＦＳＴから演算部への送信は、チューブ内部に張り巡らせたケーブルによって行われるが、無線により伝送しても良い。 Other bending detection sensors such as an encoder, a piezoelectric element, an optical sensor, and the like that are not limited to a potentiometer may be used, but a simple detection sensor is preferable because of the apparatus according to the present invention having a large number of tubes. The numerical value of the angle between the tubes detected by the potentiometer is converted into data, and several pieces of data are transmitted and accumulated in a nearby CPU. Since the CPU according to the present embodiment has a CAN communication function and one CAN network is constructed in the entire FST, data accumulated from all the CPUs is directly transmitted to the calculation unit in the FST master 18. Is done. Of course, some CPU data may be further aggregated as a group for each group, and the aggregated data may be transmitted. The transmission in the FST and the transmission from the FST to the calculation unit are performed by a cable extending inside the tube, but may be transmitted wirelessly.
図１に基づいてＦＳＴマスター（情報教示部）１８の説明をする。ＦＳＴマスターには演算部と出力部がある。演算部ではＣＰＵから送信されたデータに基づいて終端チューブや中間チューブの座標及び姿勢情報を算出し、出力部では算出されたそれらの情報を対象ロボットに送信する。ＦＳＴマスターと固着している始端チューブを起点（基準原点）として、起点に対する特定のチューブの座標及び姿勢を算出してその情報を送信しても良く、特定のチューブについて、ＦＳＴ全体の変形前の座標及び姿勢に対する変形後の座標及び姿勢の変化量を算出してその情報を送信しても良い。 The FST master (information teaching unit) 18 will be described with reference to FIG. The FST master has a calculation unit and an output unit. The calculation unit calculates the coordinates and posture information of the terminal tube and the intermediate tube based on the data transmitted from the CPU, and the output unit transmits the calculated information to the target robot. The start tube (fixed origin) fixed to the FST master may be used as a starting point (reference origin) to calculate the coordinates and orientation of a specific tube relative to the starting point and transmit the information. It is also possible to calculate the amount of change in coordinates and posture after deformation with respect to the coordinates and posture and transmit the information.
図４により、順運動学に基づいた任意のチューブの座標、姿勢の算出について説明する。本図では人体装着型ＦＳＴ教示装置０５を用い、５軸ロボットに教示を行っている。対象ロボットの手首部に対応するＦＳＴの終端チューブ１２は人間の手首に固定され、対象ロボットの肩部に対応する始端チューブ１９はＦＳＴマスター１８に固定されている。対象ロボットの肘部に対応するＦＳＴのチューブは特定されていない。 The calculation of the coordinates and posture of an arbitrary tube based on forward kinematics will be described with reference to FIG. In this figure, a human body-mounted FST teaching device 05 is used to teach a 5-axis robot. The end tube 12 of the FST corresponding to the wrist of the target robot is fixed to the human wrist, and the start tube 19 corresponding to the shoulder of the target robot is fixed to the FST master 18. The FST tube corresponding to the elbow of the target robot is not specified.
ＦＳＴではすべてのチューブが連結されており、これらが有する座標変換行列を用いて順運動学を解くことにより、ある点のチューブの位置・姿勢を求めることが可能である。
起点接続部（始端チューブ）を基準原点とし、先端へと向かう方向軸をｚ、チューブの回転軸をｙとした右手座標系で各チューブの座標変換行列を現すと現在では以下の４通りのチューブがある。なお、下式において、「50」はチューブ長（ｍｍ）を「Ry」はポテンショメータより得られる角度を表わす。
Tn＝Tna・T (n-1)b・・・・T3c・T2b・T1a
In FST, all the tubes are connected, and the position / posture of the tube at a certain point can be obtained by solving the forward kinematics using the coordinate transformation matrix that they have.
When the coordinate transformation matrix of each tube is expressed in the right-handed coordinate system, where the starting point connection (starting tube) is the reference origin, the direction axis toward the tip is z, and the rotation axis of the tube is y, the following four tubes are currently shown: There is. In the following formula, “50” represents the tube length (mm) and “Ry” represents the angle obtained from the potentiometer.
T n ＝ T na・ T (n-1) b・ ・ ・ ・ T 3c・ T 2b・ T 1a
選定された特定のチューブの位置及び姿勢情報は順運動学に基づいて計測され、出力部より教示対象ロボットに伝送される。教示対象ロボットはその情報を自己の移動情報に置換し、又は、自己の移動システムに適用して、ハンド等やハンド及び関節等についての移動指令を行う。又、本発明に係るＦＳＴ教示装置が選定された終端チューブ等の特定のチューブの位置及び姿勢の情報に加え、その特定のチューブの位置及び姿勢を満たすための中間部分の位置及び姿勢の情報も求められている場合は、順運動学に基づいて終端チューブ等の位置及び姿勢を計測した後に、逆運動学に基づいて中間関節等中間部分の位置及び姿勢を算出し、それらの情報を併せて伝送することができる。なお、逆運動学そのものは公知の手法であり説明は省略する。 The position and orientation information of the selected specific tube is measured based on forward kinematics, and transmitted from the output unit to the teaching target robot. The teaching target robot replaces the information with its own movement information, or applies it to its own movement system, and issues a movement command for the hand, the hand, the joint, and the like. In addition to the information on the position and orientation of a specific tube such as a terminal tube selected by the FST teaching apparatus according to the present invention, the information on the position and orientation of an intermediate portion for satisfying the position and orientation of the specific tube is also included. If required, after measuring the position and posture of the end tube based on forward kinematics, calculate the position and posture of the intermediate part such as the intermediate joint based on inverse kinematics, and combine these information Can be transmitted. Inverse kinematics itself is a well-known technique and will not be described.
逆運動学によってその中間関節の角度（位置）を求める場合、順運動学に基づく場合と異なり、一意に角度（位置）が定まらない場合がある。図４（肩３軸、肘１軸、手首１軸の５軸ロボットを想定）に基づいてロボット肘部２５やロボット肩部２４の位置を算出する方法について説明する。
１ 先ず、順運動学に基づいて移動後のＦＳＴ教示装置の終端チューブの位置と姿勢を求める。
２ １により移動後のロボット手首部の位置と姿勢が定まる。
３ 次に、ロボット手首部の位置から、ＦＳＴ終端チューブの移動完了時の進行方向から反対方向にロボット前腕長を差し引いた位置をロボット肘部２５の位置と推定することにより、ロボット肘部２５の位置を求め、既知の手首部位置、肩部２４位置とのベクトル、すなわち、前腕ベクトルVW、上腕ベクトルVｅを求める。
４ 上腕ベクトルVｅから肩の２軸（肩旋回軸と肩上下軸）の角度が定まる。
５ ４で求めた角度から、順運動学を解いて、ロボットの肘の曲げ軸ベクトルを求める。
６ 外積により上腕ベクトルVｅと前腕ベクトルVWに垂直なベクトルを求め、５の結果と内積を取ることで、肩の残りの軸の角度を求める。
７ 上腕ベクトルVｅと前腕ベクトルVWの内積を取ることにより、肘の曲げ角度が決まる。
８ 以上の演算により求められた角度から、再度順運動学を解いて、手首の曲げ軸のベクトルを求める。
９ ８で求めた曲げ軸ベクトルとFSTにより計測されたと曲げ軸ベクトルとの内積をとり、手首の回転角度を求める。
When the angle (position) of the intermediate joint is obtained by inverse kinematics, the angle (position) may not be uniquely determined, unlike the case based on forward kinematics. A method of calculating the positions of the robot elbow 25 and the robot shoulder 24 based on FIG. 4 (assuming a five-axis robot with three shoulders, one elbow, and one wrist) will be described.
1. First, the position and posture of the terminal tube of the FST teaching device after movement are obtained based on forward kinematics.
2 1 determines the position and posture of the robot wrist after movement.
3 Next, the position of the robot elbow 25 is estimated by subtracting the robot forearm length from the position of the robot wrist in the opposite direction from the moving direction when the movement of the FST end tube is completed. The position is obtained, and vectors of the known wrist position and shoulder 24 position, that is, the forearm vector V W and the upper arm vector Ve are obtained.
4 The angle of the two axes of the shoulder (shoulder turning axis and shoulder vertical axis) is determined from the upper arm vector Ve.
5 From the angle obtained in step 4, solve the forward kinematics to obtain the bending axis vector of the robot's elbow.
6 Obtain a vector perpendicular to the upper arm vector Ve and the forearm vector V W from the outer product, and obtain the result of 5 and the inner product to obtain the angle of the remaining axis of the shoulder.
7 The bending angle of the elbow is determined by taking the inner product of the upper arm vector Ve and the forearm vector V W.
8 From the angle obtained by the above calculation, the forward kinematics is solved again to obtain the vector of the wrist bending axis.
98 The inner product of the bending axis vector obtained in step 8 and the bending axis vector measured by FST is taken to determine the rotation angle of the wrist.
別の方法によりロボットの中間関節の位置（角度）を一意に定めることもできる。ＦＳＴの連なるチューブのうち、終端チューブに加え、ロボットの肘等の関節位置に対応する位置にある中間チューブを特定し、終端チューブ及び特定された中間チューブの複数チューブの位置と姿勢を算出する。当該算出情報を対象ロボットに送信すれば、対象ロボットのハンド及び中間関節の位置と姿勢を併せて教示することができる。かかる方法とロボット内のコントローラによる駆動システムとを並行して実施し、一方を他方の補完方式としても良い。 The position (angle) of the intermediate joint of the robot can be uniquely determined by another method. Among the tubes connected to the FST, in addition to the terminal tube, an intermediate tube at a position corresponding to a joint position such as an elbow of the robot is specified, and the positions and postures of the terminal tube and the plurality of specified intermediate tubes are calculated. If the calculation information is transmitted to the target robot, the position and posture of the target robot's hand and intermediate joint can be taught together. Such a method and a drive system by a controller in the robot may be performed in parallel, and one of them may be used as a complement method for the other.
図３は、教示対象ロボットのコントローラ３０とドライバ４０の構成図である。コントローラとドライバはロボットの足元の匡体に収納されている。コントローラ３０にはデータベース３１と位置決め制御ユニット３２等が含まれている。又、ドライバ４０にはマイコン４１、変調部４２、駆動電力出力部４３があり、モータ、減速機４５に繋がっている。モータはエンコーダ（図示していない）が装着されている。ＦＳＴ教示装置による座標・姿勢情報を取得した後、ロボットのコントローラ内の位置決め制御ユニットでロボットハンドの座標及び姿勢の認識及びそれを満たすためのモータの駆動パターンが作成され、パルス信号により駆動司令が行われる。コントローラからの指令に基づきドライバは変調した電力をモータに供給し、モータは減速機を通じてアームを回転させる。アームの回転に基づきエンコーダにより関節角度が検知され、検知情報がフィードバックされる。 FIG. 3 is a configuration diagram of the controller 30 and the driver 40 of the teaching target robot. The controller and driver are housed in the robot's feet. The controller 30 includes a database 31, a positioning control unit 32, and the like. The driver 40 includes a microcomputer 41, a modulation unit 42, and a drive power output unit 43, which are connected to a motor and a speed reducer 45. The motor is equipped with an encoder (not shown). After acquiring the coordinate and orientation information by the FST teaching device, the robot control pattern in the robot controller is created by the positioning control unit in the robot controller, and the motor drive pattern to satisfy it is created. Done. Based on a command from the controller, the driver supplies modulated electric power to the motor, and the motor rotates the arm through the speed reducer. Based on the rotation of the arm, the joint angle is detected by the encoder, and the detection information is fed back.
次に、ＦＳＴ教示装置に外部入力手段を加えた場合について説明する。実施例１では、ＦＳＴ教示装置による特定のチューブの起点（基準原点）に対する座標及び姿勢情報、又は特定のチューブの、ＦＳＴ変形前の座標及び姿勢に対する変形後の変化量を計測し、計測情報をロボットに送信する。座標原点の変換、ＦＳＴの座標及び姿勢情報のロボットにおける座標及び姿勢への置換、ロボットにおけるハンド等の座標及び姿勢を満たすための関節角度の決定は、基本的にロボット側のコントローラにより行われていた。 Next, a case where external input means is added to the FST teaching apparatus will be described. In the first embodiment, the coordinate and orientation information with respect to the starting point (reference origin) of a specific tube by the FST teaching device, or the amount of change after deformation of the specific tube with respect to the coordinates and orientation before the FST deformation is measured, and the measurement information is Send to robot. Conversion of the coordinate origin, replacement of FST coordinates and posture information with coordinates and postures in the robot, and determination of joint angles to satisfy the coordinates and postures of the hands and the like in the robot are basically performed by a controller on the robot side. It was.
ＦＳＴ教示装置に外部入力手段を加え、ロボットの属性情報やＦＳＴ教示装置の座標系と教示対象ロボットの座標系の座標変換情報を入力しておけば、入力データに基づいて、ＦＳＴ教示装置の演算部で、座標原点の変換、ＦＳＴの座標及び姿勢情報のロボットにおける座標及び姿勢への置換、ロボットにおけるハンド等の座標及び姿勢を満たすための関節角度の決定の全部又は一部を行うことが可能となる。 If external input means is added to the FST teaching device and the robot attribute information and the coordinate conversion information of the coordinate system of the FST teaching device and the coordinate system of the teaching target robot are input, the calculation of the FST teaching device is performed based on the input data. Can perform all or part of the conversion of the coordinate origin to satisfy the coordinates and posture of the hand, etc. in the robot, conversion of the coordinate origin, replacement of the FST coordinate and posture information with the coordinate and posture in the robot It becomes.
図５は、本発明に係る外部入力手段を加えたＦＳＴ教示装置に対応するロボットを示している。外部入力手段はＦＳＴマスターに組み込まれた操作パネル５７（図１）で、タッチセンサーにより入力可能となっている。ＦＳＴマスターと分離した機器としても良い。人体装着型ＦＳＴ教示装置の場合はハンディなリモコン式入力機器とすることが好ましい。又、入力手段による入力値に基づいた演算を行うロボット関節制御演算はＦＳＴマスター内の演算部で共通して行われるが、別に設けても良い。 FIG. 5 shows a robot corresponding to the FST teaching apparatus to which external input means according to the present invention is added. The external input means is an operation panel 57 (FIG. 1) incorporated in the FST master and can be input by a touch sensor. It may be a device separated from the FST master. In the case of a human-mounted FST teaching device, it is preferable to use a handy remote-control input device. Further, the robot joint control calculation for performing the calculation based on the input value by the input means is performed in common by the calculation unit in the FST master, but may be provided separately.
以下に、図５に示した教示対象ロボットに教示する際のデータ入力の具体的手順を述べる。まず、入力手段にロボットの総関節数を入力する。図５では、７軸なので「７」と入力する。操作パネルに表示した数値から「７」を選択するようにしても良い。次に、それぞれの軸の機能を入力する。図５では、第１関節を「回転」と、第２関節を「屈曲Ｘ」と第３関節を「回転」（以下略）と第７関節まで入力する。ＦＳＴマスター内のタッチパネルに「回転」、「屈曲X」、「屈曲Y」の項目を表示して選択するようにしても良い。次に、それぞれの軸間距離を入力する、図５では、床から第１関節までの長さを例えば、「１３０mm」、第１関節から第２関節までの長さを「３００mm」（以下略）と軸間の長さを入力する。入力が完了すると、ＦＳＴ教示装置から出力されるハンド等の座標・姿勢情報に対応するロボットのハンド及び各軸の位置と角度が演算部で、逆運動学に基づいて算出され、算出されたデータはロボットに送信される。 A specific procedure for data input when teaching the teaching target robot shown in FIG. 5 will be described below. First, the total number of joints of the robot is input to the input means. In FIG. 5, since it is 7 axes, “7” is input. You may make it select "7" from the numerical value displayed on the operation panel. Next, the function of each axis is input. In FIG. 5, the first joint is “rotated”, the second joint is “bent X”, the third joint is “rotated” (hereinafter abbreviated), and the seventh joint is input. The items “Rotation”, “Bend X”, and “Bend Y” may be displayed and selected on the touch panel in the FST master. Next, the distance between the axes is input. In FIG. 5, the length from the floor to the first joint is, for example, “130 mm”, and the length from the first joint to the second joint is “300 mm” (hereinafter abbreviated). ) And the length between the axes. When the input is completed, the position and angle of the robot hand and each axis corresponding to the coordinate / posture information of the hand etc. output from the FST teaching device are calculated based on inverse kinematics in the calculation unit, and the calculated data Is sent to the robot.
図６はＦＳＴ教示装置にデータ自動取得による入力手段を設けた場合のＦＳＴ教示装置と教示対象ロボットの概念図である。教示対象ロボットは７軸ロボット２０Ａ,５軸ロボット２０Ｂ、６軸ロボット２０Ｃの３基であり、それぞれＦＳＴ教示装置と接続され、タッチパネルにおける入力作業をすることなく各々のロボットの軸数等の情報は自動取得される。本実施形態では有線により接続されているが、無線による接続でも何ら差し支えない。 FIG. 6 is a conceptual diagram of the FST teaching device and the teaching target robot when the FST teaching device is provided with an input means by automatic data acquisition. There are three robots to be taught: a 7-axis robot 20A, a 5-axis robot 20B, and a 6-axis robot 20C. Each robot is connected to an FST teaching device, and information such as the number of axes of each robot can be obtained without performing an input operation on the touch panel. Automatically acquired. In the present embodiment, a wired connection is used, but a wireless connection may be used.
ロボットのデータベースに保存されている固有の軸情報に基づき、ＦＳＴ教示装置内で素早くロボットのハンド及び各軸の位置と角度情報が送信される。ロボットコントローラは送信される情報にトルク指令又は速度指令とトルク指令を加えて、ドライバ４０を通じてモータを回転させる。ロボットにおけるコントローラ機能の一部はＦＳＴ教示装置に代替され省略可能である。なお、残る機能に係るコントローラとドライバをロボットアーム内に配設すれば、ロボットに隣接する匡体をなくすることができ、省スペース効果が大きい。 Based on the unique axis information stored in the robot database, the robot hand and the position and angle information of each axis are quickly transmitted within the FST teaching apparatus. The robot controller adds a torque command or a speed command and a torque command to the transmitted information, and rotates the motor through the driver 40. A part of the controller function in the robot can be replaced with the FST teaching device and can be omitted. If the controller and driver related to the remaining functions are arranged in the robot arm, the housing adjacent to the robot can be eliminated, and the space saving effect is great.
ＦＳＴ教示装置は７軸ロボットの軸数等の情報に基づき７軸ロボットに移動教示を行い、続いて同様に５軸ロボット、６軸ロボットに教示を行う。同じ移動内容の教示をリピートして構造の異なるロボットに教示することも、ロボットごとに異なる移動内容の教示を行うこともできる。さらに、同じ移動内容の教示を５軸ロボット、６軸ロボット、７軸ロボットという構造の異なるロボットに同時に教示することも可能である。 The FST teaching device teaches the movement to the 7-axis robot based on the information such as the number of axes of the 7-axis robot, and then similarly teaches the 5-axis robot and the 6-axis robot. The teaching of the same movement content can be repeated to teach a robot having a different structure, or the different movement contents can be taught for each robot. Furthermore, it is possible to simultaneously teach the same movement content to different robots such as a 5-axis robot, a 6-axis robot, and a 7-axis robot.
図１２はＦＳＴ教示装置によるロボット制御とロボットコントローラの関係を示す概念図である。図１２（１）では、ＦＳＴ教示装置はロボットの軸数等の属性情報を取得し、ロボットの位置制御を行っている。ロボット側のコントローラでは、ＦＳＴ教示装置による位置指令に加え、ドライバに速度、トルクの指令を行う。又、図１２（２）では、ＦＳＴ教示装置による位置及び速度指令に加え、ロボット側のコントローラはトルク指令を行う。このように本発明にかかるＦＳＴ教示装置はロボットコントローラの機能を代替することができる。 FIG. 12 is a conceptual diagram showing the relationship between the robot control by the FST teaching device and the robot controller. In FIG. 12 (1), the FST teaching apparatus acquires attribute information such as the number of axes of the robot and performs position control of the robot. The controller on the robot side issues a speed and torque command to the driver in addition to the position command from the FST teaching device. In FIG. 12 (2), in addition to the position and speed commands from the FST teaching device, the controller on the robot side issues a torque command. Thus, the FST teaching apparatus according to the present invention can replace the function of the robot controller.
図７は人体装着型ＦＳＴ教示装置の概念図である。ＦＳＴマスター１８は座標及び姿勢変動の少ない背中央上部に固定されている。ＦＳＴチューブ１１は左腕に沿って配設されている。腕における可動部である肘部と手首部の位置及び姿勢の変動を把握すべく、肘部には肘部固定チューブ５０が、手首部には手首部固定チューブ５１がそれぞれ固定バンド５２によって固定されている。肘部固定チューブは始端チューブからｎ番目のチューブであり、手首固定チューブは始端チューブからｍ番目のチューブである。手首部固定チューブ及び肘部固定チューブの２つのチューブの位置及び姿勢変化情報は計測・演算され、対象ロボットに送信される。人間装着型の場合はＦＳＴの終端チューブをつまんで保持し続けるという負担がなく、より容易に教示動作を継続することが可能である。 FIG. 7 is a conceptual diagram of a human body-mounted FST teaching apparatus. The FST master 18 is fixed to the upper center of the back with little change in coordinates and posture. The FST tube 11 is disposed along the left arm. In order to grasp fluctuations in the position and posture of the elbow and wrist that are movable parts of the arm, an elbow fixing tube 50 is fixed to the elbow and a wrist fixing tube 51 is fixed to the wrist by a fixing band 52. ing. The elbow fixing tube is the nth tube from the starting end tube, and the wrist fixing tube is the mth tube from the starting end tube. The position and posture change information of the two tubes, the wrist fixed tube and the elbow fixed tube, are measured and calculated and transmitted to the target robot. In the case of a human wearable type, there is no burden of holding and holding the FST end tube, and the teaching operation can be continued more easily.
図８は図７と同じＦＳＴ教示装置を子供や女性など体の小さな者に装着した図である。肘部と手首部には、図７と同様に肘部固定チューブ５０と手首部固定チューブ５１がそれぞれ固定バンド５２によって固定されている。同じＦＳＴを用いているので、子供に装着した場合には、肩から肘及び肘から手首までの各チューブは腕から離れ垂れ下がっている。しかし、肘部固定チューブは始端チューブからｎ番目のチューブ、手首固定チューブは始端チューブからｍ番目のチューブであり図７の大人に装着した場合と同一である。位置及び姿勢の変動を把握するチューブ以外のチューブが腕に密着していようと離れて垂れ下がっていようと影響はない。このように、本発明に係るＦＳＴ教示装置は装着する人間の身長や体重に影響なく教示することができる。体の小さな者の場合、チューブ群全体を使用せず、中間位置のチューブを終端チューブとみなして設定を行い、その中間位置のチューブの位置と姿勢の変動の計測に基づいて対象ロボットの手首の位置及び姿勢を教示することも可能である。 FIG. 8 is a diagram in which the same FST teaching apparatus as that in FIG. 7 is attached to a small person such as a child or a woman. As in FIG. 7, an elbow fixing tube 50 and a wrist fixing tube 51 are fixed to the elbow and wrist by a fixing band 52. Since the same FST is used, each tube from the shoulder to the elbow and from the elbow to the wrist hangs away from the arm when worn on a child. However, the elbow fixing tube is the n-th tube from the starting end tube, and the wrist fixing tube is the m-th tube from the starting end tube, which is the same as the case of being attached to the adult in FIG. There is no effect whether a tube other than the tube that grasps the change in position and posture is in close contact with the arm or hanging down. As described above, the FST teaching apparatus according to the present invention can teach without influence on the height and weight of a person to be worn. In the case of a small body, do not use the entire tube group, set the tube at the intermediate position as the end tube, and set the wrist position of the target robot based on the measurement of the change in the position and posture of the tube at the intermediate position. It is also possible to teach the position and orientation.
人体装着型ＦＳＴ教示装置によりロボットにハンドの座標及び姿勢を教示する場合には、主に人間の手首又は肘と手首の座標及び姿勢が問題となる。図４に基づいて説明すると、
人体装着型ＦＳＴ教示装置の移動の起点は始端チューブ１９である。始端チューブに対して終端チューブ１２又は終端チューブと中間チューブの位置と姿勢がどのように変化するかを計測して、ロボットの肩２４に対するハンド（手首）２６や肘２５の座標及び姿勢を教示するのである。
When teaching the coordinates and posture of the hand to the robot using the human body wearing type FST teaching device, the coordinates and posture of the human wrist or elbow and wrist are mainly problematic. Based on FIG.
The starting point of the movement of the human-body-mounted FST teaching device is the start end tube 19. Measure how the position and posture of the end tube 12 or the end tube and the intermediate tube change with respect to the start end tube, and teach the coordinates and postures of the hand (wrist) 26 and elbow 25 with respect to the shoulder 24 of the robot. It is.
しかし人間の腕の動きとロボットの腕の動きには相違がある。図９は、人間が腕を曲げたときと伸ばしたときの概念図である。ＦＳＴ教示装置は人間に装着されているが、図示していない。腕を曲げたときの手首の位置は５５で肘の位置は５４である。この場合、肩の位置は５３である。次に、腕を伸ばしたときの手首の位置は５５Ａで肘の位置は５４Ａであるが、このときの肩の位置は５３Ａに移動しており、腕を曲げたときの位置５３から手首方向に移動している。計測対象のチューブが肘と手首に固定されたチューブである場合、
それらのチューブの移動量（座標の変動量）には、肘及び手首の移動量に肩の移動量も加算される。したがって、肩位置が固定されているロボットに移動教示する場合には、誤った教示を行う可能性がある。
However, there is a difference between the movement of the human arm and the movement of the robot arm. FIG. 9 is a conceptual diagram when a human bends and extends an arm. The FST teaching device is worn by a human but is not shown. The wrist position when the arm is bent is 55, and the elbow position is 54. In this case, the shoulder position is 53. Next, the wrist position when the arm is extended is 55A and the elbow position is 54A. At this time, the shoulder position is moved to 53A, and the wrist position is shifted from the position 53 when the arm is bent toward the wrist. Has moved. If the tube to be measured is a tube fixed to the elbow and wrist,
The amount of movement of the tubes (the amount of change in coordinates) includes the amount of movement of the shoulder in addition to the amount of movement of the elbow and wrist. Therefore, there is a possibility that erroneous teaching is performed when teaching the movement of the robot whose shoulder position is fixed.
図１０は、ＦＳＴの計測対象チューブを人間の手首部、肘部、及び肩部に固定した場合の概念図である。肩部固定チューブ５１Ａは固定バンド５２により固定されている。３点配置することにより、肩の移動を減算した正確な情報を教示することが可能となる。ＦＳＴマスターに連結する始端チューブは、肩の移動を正確に反映できるように、できるだけ背中央部に近い位置に配置することが好ましい。 FIG. 10 is a conceptual diagram when the measurement target tube of FST is fixed to a human wrist, elbow, and shoulder. The shoulder fixing tube 51A is fixed by a fixing band 52. By arranging three points, it is possible to teach accurate information obtained by subtracting the movement of the shoulder. The starting tube connected to the FST master is preferably arranged as close to the center of the back as possible so that the movement of the shoulder can be accurately reflected.
［他の実施例］
図１０は交互配置のＦＳＴ構成図である。各チューブはほぼ同一の長さを有している。軸長が同一ないしほぼ同一の場合、ＦＳＴ全体の中の特定のチューブの位置の把握が容易になる。各チューブに連番による番号を付しても良い。又、さらに１）Ｘ可動部チューブ、Ｙ可動部チューブ、Ｚ可動部チューブを交互配置２）Ｘ可動部チューブ、Ｚ可動部チューブを交互配置３）Ｙ可動部チューブ、Ｚ可動部チューブを交互配置すると、可動方向が異なるチューブが交互に並ぶので、バランスのとれた滑らかな移動（変形）を行うことができる。
[Other embodiments]
FIG. 10 is a diagram showing the FST configuration arranged alternately. Each tube has approximately the same length. When the axial length is the same or substantially the same, it is easy to grasp the position of a specific tube in the entire FST. You may attach | subject the number by a serial number to each tube. In addition, 1) X movable part tube, Y movable part tube, Z movable part tube are arranged alternately 2) X movable part tube, Z movable part tube are arranged alternately 3) Y movable part tube, Z movable part tube are arranged alternately Then, since the tubes having different movable directions are alternately arranged, a balanced and smooth movement (deformation) can be performed.
図１３ではＦＳＴマスター１８に姿勢センサ５６を装着している。ロボットに移動教示する場合、しばしば自然に体が傾いたり、背伸びしたり、しゃがんだりすることがある。このような場合には、始端チューブ（基準原点）１９の座標が変動してロボットの基準原点との対応関係に変動が生じることになる。本実施例ではＦＳＴマスター１８に姿勢センサ５６を装着し、ＦＳＴマスター自体（基準原点と連動）の移動・姿勢を計測することにより、ロボットの基準原点との間に生じた座標の対応関係の変動を矯正する。 In FIG. 13, the attitude sensor 56 is attached to the FST master 18. When teaching a robot to move, the body often tilts naturally, stretches back, or squats. In such a case, the coordinates of the starting end tube (reference origin) 19 fluctuate, and the correspondence relationship with the reference origin of the robot changes. In this embodiment, the orientation sensor 56 is attached to the FST master 18 and the movement and orientation of the FST master itself (in conjunction with the reference origin) is measured, thereby changing the correspondence of coordinates generated between the robot and the reference origin. To correct.
図１４は本発明に係るＦＳＴロボット移動教示装置にデッドマンスイッチシステムを付加した概念図である。デッドマンスイッチシステムは専用のワイヤードスイッチを用い、教示対象ロボット本体２０から１本の配線、コネクタ、スイッチがすべて繋がった状態の場合にのみロボットへの移動教示が有効に働く。又、ＦＳＴ教示装置内では、ＦＳＴマスター１８、左手ＦＳＴ,左手ハンドコントローラ５９Ｌ、右手ＦＳＴ、右手ハンドコントローラ５９Ｒがすべて接続されると共にハンドグリップ６０が適度な力で握られた場合に初めてロボットへの移動教示が可能となる一方、いずれか一方又は両方を離したり、強い力で握りしめるとロボットの駆動が非常停止状態となる。したがって極めて安全性が高い。 FIG. 14 is a conceptual diagram in which a deadman switch system is added to the FST robot movement teaching apparatus according to the present invention. The deadman switch system uses a dedicated wired switch, and the movement teaching to the robot works effectively only when one wiring, connector, and switch are all connected from the robot body 20 to be taught. In the FST teaching device, the FST master 18, the left hand FST, the left hand controller 59L, the right hand FST, and the right hand controller 59R are all connected and when the hand grip 60 is gripped with an appropriate force, the robot is not connected to the robot for the first time. While it is possible to teach movement, if one or both of them are separated or grasped with a strong force, the driving of the robot becomes an emergency stop state. Therefore, it is extremely safe.
ＦＳＴロボット移動教示装置とデッドマンスイッチシステム間を無線により接続することも可能である。配線を省略できる一方、確実な伝送に担保される安全性は上記有線方式よりやや低下する。又、デッドマンスイッチシステムの伝送をＦＳＴロボット移動教示装置のバス等に乗せて通信することも可能である。この場合、専用ケーブルが不要になり、簡便にデッドマンスイッチシステムを導入できるが、ＦＳＴロボット移動教示装置側の不具合によりデッドマンスイッチシステムが働かなくなるという問題もある。 It is also possible to wirelessly connect the FST robot movement teaching device and the deadman switch system. While wiring can be omitted, the safety secured by reliable transmission is slightly lower than that of the wired system. It is also possible to communicate the transmission of the deadman switch system on the bus of the FST robot movement teaching device. In this case, a dedicated cable is not required and a deadman switch system can be easily introduced, but there is also a problem that the deadman switch system does not work due to a problem on the FST robot movement teaching device side.
本発明は、様々なタイプの多関節ロボットに対して操作者の大小や体型に関係なく汎用的に、かつ、簡便に教示することができるロボット教示装置を提供するもので、産業上の利用価値は大きい。 The present invention provides a robot teaching apparatus that can teach various types of articulated robots in a general and simple manner regardless of the size and body shape of an operator. Is big.
０５ ＦＳＴ教示装置
１０ ＦＳＴ
１１ 可動部を有するチューブ
１２ 終端チューブ
１３ Ｘ軸方向への屈曲が可能な可動部（Ｘ可動部）
１４ Ｙ軸方向への屈曲が可能な可動部（Ｙ可動部）
１５ Ｚ軸を中心とした回転が可能な可動部（Ｚ可動部）
１６ ポテンショメータ
１７ 通信機能付きＣＰＵ
１８ ＦＳＴマスター（情報教示部）
１９ 始端チューブ
２０ 教示対象ロボット
２１ ロボットアーム
２２ ロボット屈曲関節
２３ ロボット軸回転関節
２４ ロボット肩部
２５ ロボット肘部
２６ ロボットハンド
３０ コントローラ
３１ データベース
３２ 位置決め制御ユニット
４０ ドライバ
４１ マイコン
４２ 変調部
４３ 駆動電力出力部
４５ 減速機
５０ 肘部固定チューブ
５１ 手首部固定チューブ
５１Ａ 肩部固定チューブ
５２ 固定バンド
５３ 肩
５４ 肘
５５ 手首
５６ 姿勢センサ
５７ 操作パネル
５８ デッドマンスイッチシステムケーブル
５９ ハンドコントローラ
６０ ハンドグリップ
05 FST teaching device 10 FST
11 Tube 12 having movable portion Terminal tube 13 Movable portion capable of bending in the X-axis direction (X movable portion)
14 Movable part that can be bent in the Y-axis direction (Y movable part)
15 Movable part that can rotate around the Z axis (Z movable part)
16 Potentiometer 17 CPU with communication function
18 FST Master (Information Teaching Department)
19 Start tube 20 Teaching target robot 21 Robot arm 22 Robot bending joint 23 Robot axis rotation joint 24 Robot shoulder 25 Robot elbow 26 Robot hand 30 Controller 31 Database 32 Positioning control unit 40 Driver 41 Microcomputer 42 Modulation unit 43 Drive power output unit 45 Reduction gear 50 Elbow fixed tube 51 Wrist fixed tube 51A Shoulder fixed tube 52 Fixed band 53 Shoulder 54 Elbow 55 Wrist 56 Posture sensor 57 Operation panel 58 Deadman switch system cable 59 Hand controller 60 Hand grip
Claims (16)
上記フレキシブルセンサチューブは、可動部を有するチューブが多数連なるチューブ群と隣接するチューブ間の角度を検出するセンサと検出した角度データを伝送する通信部により構成され、
上記情報教示部は、上記伝送された角度データを演算処理する演算部と処理された座標姿勢情報を出力する出力部により構成される
ロボット移動教示装置において、
上記チューブ群が、少なくともＸ軸又はＹ軸方向への屈曲が可能な、上記可動部を有する多数のチューブ、並びに少なくともＺ軸を中心とした回転が可能な、複数のチューブにより構成され、
かつ、上記フレキシブルセンサチューブの変形に伴う変形後の隣接するチューブ間のＸ軸及びＹ軸方向への屈曲並びにＺ軸を中心とした回転による角度を計測し、順運動学に基づいて１又は複数の特定の上記チューブについて、変形後の座標及び/又は姿勢を算出し、
対応する１又は複数の特定の部分についての移動後の座標及び/又は姿勢を教示することにより
教示対象ロボットに追随移動させることを特徴とするロボット移動教示装置。 A flexible sensor tube and an information teaching unit to which one end of the flexible sensor tube is fixed,
The flexible sensor tube is composed of a sensor that detects an angle between a tube group having a plurality of tubes having a movable part and an adjacent tube, and a communication unit that transmits detected angle data.
In the robot movement teaching apparatus, the information teaching unit includes an arithmetic unit that performs arithmetic processing on the transmitted angle data and an output unit that outputs processed coordinate posture information.
The tube group is composed of a plurality of tubes having the movable part capable of bending at least in the X-axis or Y-axis direction, and a plurality of tubes capable of rotating around at least the Z-axis,
In addition, one or a plurality of angles based on forward kinematics are measured based on forward kinematics by measuring the angle between the X- and Y-axis bends between the adjacent tubes after the deformation of the flexible sensor tube and the rotation about the Z-axis. Calculate the coordinates and / or posture after deformation for the specific tube
A robot movement teaching apparatus characterized by causing a robot to be taught to follow a target by teaching coordinates and / or postures after movement of one or a plurality of corresponding specific parts.
上記フレキシブルセンサチューブは、可動部を有するチューブが多数連なるチューブ群と隣接するチューブ間の角度を検出するセンサと検出した角度データを伝送する通信部により構成され、
上記情報教示部は、上記伝送された角度データを演算処理する演算部と処理された座標姿勢情報を出力する出力部により構成される
ロボット移動教示装置において、
上記チューブ群が、少なくともＸ軸又はＹ軸方向への屈曲が可能な、上記可動部を有する多数のチューブ、並びに少なくともＺ軸を中心とした回転が可能な、複数のチューブにより構成され、
かつ、上記フレキシブルセンサチューブの変形に伴う変形後の隣接するチューブ間のＸ軸及びＹ軸方向への屈曲並びにＺ軸を中心とした回転による角度を計測し、順運動学に基づいて特定の上記チューブについて、変形後の座標及び/又は姿勢を算出し、
逆運動学に基づいて対応する複数の特定の部分についての移動後の座標及び/又は姿勢を教示することにより
教示対象ロボットに追随移動させることを特徴とするロボット移動教示装置。 A flexible sensor tube and an information teaching unit to which one end of the flexible sensor tube is fixed,
The flexible sensor tube is composed of a sensor that detects an angle between a tube group having a plurality of tubes having a movable part and an adjacent tube, and a communication unit that transmits detected angle data.
In the robot movement teaching apparatus, the information teaching unit includes an arithmetic unit that performs arithmetic processing on the transmitted angle data and an output unit that outputs processed coordinate posture information.
The tube group is composed of a plurality of tubes having the movable part capable of bending at least in the X-axis or Y-axis direction, and a plurality of tubes capable of rotating around at least the Z-axis,
And the angle by the bending | flexion to the X-axis and the Y-axis direction between the adjacent tubes after a deformation | transformation with the deformation | transformation of the said flexible sensor tube, and rotation centering on a Z-axis is measured, and the above-mentioned specific based on forward kinematics For the tube, calculate the coordinates and / or posture after deformation,
A robot movement teaching device characterized by causing a robot to be taught to follow by teaching the coordinates and / or postures after movement of a plurality of corresponding specific parts based on inverse kinematics.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2009178470A JP5380192B2 (en) | 2009-07-30 | 2009-07-30 | General-purpose robot movement teaching device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2009178470A JP5380192B2 (en) | 2009-07-30 | 2009-07-30 | General-purpose robot movement teaching device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2011031327A JP2011031327A (en) | 2011-02-17 |
| JP5380192B2 true JP5380192B2 (en) | 2014-01-08 |
Family
ID=43760918
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2009178470A Expired - Fee Related JP5380192B2 (en) | 2009-07-30 | 2009-07-30 | General-purpose robot movement teaching device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5380192B2 (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| ES2435508B2 (en) * | 2012-06-19 | 2014-10-01 | Robomotion S.L. | Mobile robot with teleoperated arm through inertial motion capture system |
| CN104729455B (en) * | 2014-12-04 | 2017-01-11 | 北京航空航天大学 | Pipeline flexible welding and assembling robot posture calculation method based on measurement data |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3263939B2 (en) * | 1994-04-11 | 2002-03-11 | 株式会社安川電機 | Manipulator operation device |
| JP2776477B2 (en) * | 1996-02-13 | 1998-07-16 | 川崎重工業株式会社 | Robot 3D position and orientation teaching system |
| JP2004029999A (en) * | 2002-06-24 | 2004-01-29 | Matsushita Electric Ind Co Ltd | Tactile force display hand and its manufacturing method |
| JP4641330B2 (en) * | 2005-06-07 | 2011-03-02 | 特定非営利活動法人 国際レスキューシステム研究機構 | Traveling robot self-position identification system, human body position identification system and robot following system using the same |
| JP4821516B2 (en) * | 2006-08-31 | 2011-11-24 | 旭光電機株式会社 | Articulated structure |
| JP5282874B2 (en) * | 2007-07-09 | 2013-09-04 | 花王株式会社 | Manipulator system |
| WO2009096408A1 (en) * | 2008-02-01 | 2009-08-06 | Kyokko Electric Co, Ltd. | Articulated structure teaching device |
-
2009
- 2009-07-30 JP JP2009178470A patent/JP5380192B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2011031327A (en) | 2011-02-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5175691B2 (en) | Robot arm teaching system and method | |
| US9122275B2 (en) | Robot and control method thereof | |
| KR101992149B1 (en) | Wearable Apparatus for measuring position and action of Arm | |
| JP5725603B2 (en) | Side-mounted haptic interface | |
| US10078327B2 (en) | Teaching system of dual-arm robot and method of teaching dual-arm robot | |
| JP5093498B2 (en) | Manipulator system | |
| WO2019119724A1 (en) | Force sense information and posture information based limb motion intention understanding and upper limb rehabilitation training robot control method | |
| KR101876380B1 (en) | Manipulator and path generation method thereof | |
| JP5282874B2 (en) | Manipulator system | |
| CN110678157B (en) | Electromechanical robot manipulator device | |
| WO2021024586A1 (en) | Control device, control system, robot system, and control method | |
| CN110561403A (en) | wearable three-degree-of-freedom human body auxiliary outer mechanical arm | |
| JP2013049102A (en) | Robot control device and method of determining robot attitude | |
| JP5108032B2 (en) | Multi-joint structure teaching device | |
| KR102168774B1 (en) | Master device for robot and robot control system having the same | |
| KR101801302B1 (en) | Robot hand and surface robot system using of the same for working | |
| US11305414B2 (en) | Manipulating device | |
| JP5380192B2 (en) | General-purpose robot movement teaching device | |
| JP2001300871A (en) | Master arm device | |
| KR100895692B1 (en) | Wearable robot arm and position moving method of wearable robot arm | |
| JP3884249B2 (en) | Teaching system for humanoid hand robot | |
| JP3843319B2 (en) | Tactile interface and control method thereof | |
| JPH03104572A (en) | Method and device for controlling master slave manipulator | |
| KR20130113062A (en) | Human power amplification robot estimating user's intension by force-torque sensor and control method thereof | |
| JP7150155B2 (en) | Control devices and control systems for moving bodies |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120713 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130703 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130819 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20130917 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130930 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 5380192 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |