JP7322099B2 - Information processing method, information processing device, robot device, program, and computer-readable recording medium - Google Patents

Information processing method, information processing device, robot device, program, and computer-readable recording medium Download PDF

Info

Publication number
JP7322099B2
JP7322099B2 JP2021099342A JP2021099342A JP7322099B2 JP 7322099 B2 JP7322099 B2 JP 7322099B2 JP 2021099342 A JP2021099342 A JP 2021099342A JP 2021099342 A JP2021099342 A JP 2021099342A JP 7322099 B2 JP7322099 B2 JP 7322099B2
Authority
JP
Japan
Prior art keywords
coordinate system
information processing
robot
teaching point
display
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2021099342A
Other languages
Japanese (ja)
Other versions
JP2021151696A (en
Inventor
聡 菅谷
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Canon Inc
Original Assignee
Canon Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Priority claimed from JP2020042459A external-priority patent/JP6900533B2/en
Application filed by Canon Inc filed Critical Canon Inc
Priority to JP2021099342A priority Critical patent/JP7322099B2/en
Publication of JP2021151696A publication Critical patent/JP2021151696A/en
Application granted granted Critical
Publication of JP7322099B2 publication Critical patent/JP7322099B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、ロボット装置の各部位の位置または姿勢をそれぞれ特定する複数の位置姿勢データの編集、および位置姿勢データにより特定されるロボットの状態の表示を行う情報処理方法、情報処理装置、ロボット装置、物品の製造方法、情報処理プログラム、およびコンピュータ読み取り可能な記録媒体に関するものである。 The present invention provides an information processing method, an information processing apparatus, and a robot apparatus for editing a plurality of position/orientation data specifying the position or orientation of each part of a robot apparatus, and for displaying the state of the robot specified by the position/orientation data. , an article manufacturing method, an information processing program, and a computer-readable recording medium.

近年、例えば産業用のロボット装置による人の動作を模した組立を行う自動生産システムの開発が進んでおり、人の動作と同様に、周囲環境に配置されている障害物の間を縫うように動作させるようプログラミング(教示)することが必要になってきた。ロボット装置のプログラミング(教示)には、配置環境において実際にロボットに動作を行わせながら、その動作を実行させる位置姿勢データを蓄積、記録する、いわゆるティーチングペンダントなどと呼ばれる装置が用いられることがある。 In recent years, for example, the development of automated production systems that perform assembly that imitates human movements using industrial robot devices is progressing, and similar to human movements, weave through obstacles placed in the surrounding environment. It has become necessary to program (teach) to operate. For programming (teaching) of a robot device, a device called a so-called teaching pendant, which accumulates and records the position and orientation data that causes the robot to actually perform the motion in its placement environment, is sometimes used. .

また、ロボット装置のプログラミング(教示)には、PC(パーソナルコンピュータ)とほぼ同様のハードウェア構成を有する情報処理装置が用いられることがある。このようなロボット装置のプログラム(教示)用の情報処理装置は、表示装置、コンピュータ、キーボード、ポインティングデバイスなどのハードウェアから構成される。この種の装置は、ロボット制御用のプログラム言語の形式や、位置姿勢データの数値などの形式でロボット動作をプログラム(教示)できるよう構成される。ロボット装置のプログラム(教示)用の情報処理装置は、実際にロボット装置と接続されていないようなオフライン環境において使用することもできる。 For programming (teaching) of the robot apparatus, an information processing apparatus having a hardware configuration substantially similar to that of a PC (personal computer) may be used. An information processing device for such a robot device program (teaching) is composed of hardware such as a display device, a computer, a keyboard, and a pointing device. A device of this type is configured to be able to program (teach) robot motions in the form of a program language for robot control or in the form of numerical values of position and orientation data. The information processing device for programming (teaching) the robot device can also be used in an off-line environment where it is not actually connected to the robot device.

一方、上記のように周囲環境との干渉を考慮しながら、例えば人の動作を模した組立作業をロボット装置に行わせるには、教示作業は極めて複雑になり教示する工数が増大したり、教示ミスが多発する傾向がある。特に、上記のようなロボット装置のプログラム(教示)用の情報処理装置を用いて、実際のロボットの動作確認を行えないようなオフライン環境で行う教示作業は困難を伴ない、上記の工数増大や教示ミスなどの問題を生じがちである。 On the other hand, as described above, if a robot device is to perform an assembly operation that mimics human motion while considering interference with the surrounding environment as described above, the teaching operation becomes extremely complicated and the number of man-hours required for teaching increases. Mistakes tend to occur. In particular, using an information processing device for programming (teaching) of a robot device as described above, teaching work performed in an off-line environment in which the actual operation of the robot cannot be checked is accompanied by difficulties, resulting in an increase in man-hours and Problems such as teaching errors tend to occur.

ここで、複雑なロボット動作の例として、箱の中に複数の仕切りがあり、その異なる仕切りの中にそれぞれ1点ずつ収容されているワーク(部品)を逐一ロボット装置により取得(し、あるいはさらに他の場所に移動)するパレタイジング工程の動作を考える。このようなパレタイジングの動作では、実際には、異なる位置に収容された1個のワークにつき取得位置と取得前の上空位置の計2点の教示点が必要である。この教示点は、ロボットアーム先端の所定の基準部位の位置姿勢データのような形式で記述される。そして、複数のワークを処理するのであれば、その個々のワークに関して、少なくとも上記2点の教示点を教示する必要がある。もし、手動の教示操作によりこれら全ての教示点を教示するのであれば、ワークの数が多ければ多いほど、教示工数が増大し、その作業は極めて煩雑なものになる。 Here, as an example of a complicated robot operation, there are a plurality of partitions in a box, and workpieces (parts) stored one by one in each of the different partitions are acquired (or further Consider the operation of a palletizing process that moves to another location. Such a palletizing operation actually requires a total of two teaching points, the acquisition position and the pre-acquisition position in the sky, for each workpiece accommodated at different positions. This teaching point is described in a format such as position/orientation data of a predetermined reference portion of the tip of the robot arm. If a plurality of works are to be processed, it is necessary to teach at least the above two teaching points for each work. If all these teaching points were to be taught by manual teaching operations, the larger the number of workpieces, the greater the number of teaching man-hours and the more complicated the work would be.

そこで、教示を簡略化する手段として、1つの基準教示点から次の教示点までの相対的な移動量を設計値等から求め、その相対値をオフセットとして設定する教示手法がある。この手法によると、上記のパレタイジング動作の場合、1つの基準となるワークに対応する基準教示点を教示した後、他のワークに対してはオフセットを設定するだけでワークに対応する教示点を教示できるようになる。 Therefore, as means for simplifying teaching, there is a teaching method in which the amount of relative movement from one reference teaching point to the next teaching point is obtained from a design value or the like, and the relative value is set as an offset. According to this method, in the case of the above palletizing operation, after teaching the reference teaching points corresponding to one reference workpiece, the teaching points corresponding to the other workpieces are taught only by setting the offset. become able to.

下記の特許文献1および特許文献2は、上記の基準教示点のオフセットとして相対値を設定する手段を用い、それぞれ異なる座標系方向の相対値をオフセットとして設定する技術を開示している。特許文献1は、基準となる教示点からロボットのベース座標系方向に対するオフセットを、動作プログラムの中のオフセット変数で設定し、軌道計算を行うことでオフセット先の位置姿勢に移動させる方法を記している。このオフセットの利点は、ロボットの上下、前後、左右方向の移動が行い易いという点である。しかし、斜め方向や並進と回転を多用したオフセットを行う場合には、方向や角度に応じた行列計算を行う必要があり、計算や設定ミスなどが発生し易い問題がある。 Patent Documents 1 and 2 below disclose techniques for setting relative values in different coordinate system directions as offsets using means for setting relative values as offsets of the reference teaching point. Patent Literature 1 describes a method of setting an offset from a teaching point that serves as a reference in the direction of a robot's base coordinate system using an offset variable in a motion program, and moving the robot to the position and orientation of the offset destination by calculating a trajectory. there is The advantage of this offset is that the robot can be easily moved up and down, back and forth, and left and right. However, in the case of performing an offset that uses an oblique direction or a lot of translation and rotation, it is necessary to perform matrix calculation according to the direction and angle, and there is a problem that calculation and setting errors are likely to occur.

一方、特許文献2では、基準となる教示点から、ロボットのツール先端に定義したツール座標系方向に対するオフセットを動作プログラムの中のオフセット変数で設定し、軌道計算を行うことでオフセット先の位置姿勢に移動させる方法を開示している。このツール座標系は、例えば作業者が任意に設定できるTCP(ツールセンターポイント)を原点とした座標系である。この手法によると、例えば基準部位の斜め方向の移動では、斜め方向とツール座標系の一方向が同一直線上になる様にTCPを設定し、一方向に移動量となる相対値を設定することにより所期の斜め方向の移動を実現できる。 On the other hand, in Japanese Patent Application Laid-Open No. 2002-200011, an offset variable in the motion program is used to set an offset in the direction of the tool coordinate system defined at the tool tip of the robot from the teaching point serving as a reference, and the trajectory is calculated. It discloses how to move to This tool coordinate system is, for example, a coordinate system whose origin is a TCP (tool center point) that can be arbitrarily set by the operator. According to this method, for example, when the reference portion is moved in an oblique direction, the TCP is set so that the oblique direction and one direction of the tool coordinate system are on the same straight line, and a relative value that is the amount of movement in one direction is set. , the desired oblique movement can be realized.

特許文献2のように、ベース座標系以外の作業者が把握し易い座標系、例えば上記のツール座標系を用いることにより、例えば数値入力などにより教示点を設定する作業が楽になり、設定ミスを低減できると考えられる。例えば、上記のツール座標系を用いれば、現在のロボットの姿勢に対する手先方向、のように作業者がイメージしやすい座標系における相対値情報によって教示点を入力、あるいは編集することができる。これにより、例えば設計値から相対値情報を算出するようなデータ操作が容易になり、教示工数や作業ミスを削減できる。パレタイジング工程であれば、ワークを取得位置の1つを基準となる教示点として設定し、残りのワークの取得位置と取得前位置を、例えばベース座標系のオフセットとして相対的に等間隔で設定することで教示を行える。 As in Patent Document 2, by using a coordinate system other than the base coordinate system that is easy for the operator to grasp, such as the tool coordinate system described above, the task of setting teaching points by, for example, entering numerical values becomes easier, and setting errors are reduced. can be reduced. For example, by using the above tool coordinate system, it is possible to input or edit teaching points based on relative value information in a coordinate system that is easy for the operator to imagine, such as the hand direction with respect to the current posture of the robot. This facilitates data manipulation such as calculating relative value information from design values, for example, and reduces teaching man-hours and work errors. In the case of a palletizing process, one of the workpiece acquisition positions is set as a reference teaching point, and the remaining workpiece acquisition positions and pre-acquisition positions are set at relatively equal intervals, for example, as offsets of the base coordinate system. You can teach by

ここで、設置現場でティーチングペンダントなどを用いて実際のロボットを動作させながら教示を行う場合と、上述のような情報処理装置を用いてオフラインで教示を行う場合では、それぞれに一長一短がある。例えば、上記のパレタイジング工程の場合、設定したオフセット後の位置姿勢を実機のロボットで確認すると、確認中に箱の仕切りに干渉してしまう可能性があった。一方、オフラインで用いられる情報処理装置には、上記のオフセットなどを用いた教示点の入力方式を豊富に用意することができる。また、実際のロボットを動作させなくてもプログラミングで可能であるため、配置環境との干渉などを生じることなく動作確認を行える利点がある。 Here, there are advantages and disadvantages between teaching while operating an actual robot using a teaching pendant or the like at the installation site and teaching off-line using the above-described information processing device. For example, in the case of the above palletizing process, if the position and orientation after the set offset are confirmed by an actual robot, there is a possibility that the box partitions will interfere during confirmation. On the other hand, an information processing apparatus used off-line can be provided with a variety of teaching point input methods using the above-described offset or the like. In addition, since it is possible to program without actually operating the robot, there is an advantage that the operation can be confirmed without causing interference with the placement environment.

そこで、近年では、オフラインで利用する情報処理装置において、オフラインで教示、および動作確認を行える構成が提案されている。例えば、作成した教示データを用いて、実機を動作させるのではなく、教示データに基づく軌道計算や3Dモデルのレンダリングを行って、仮想表示によるロボットを表示画面中で動作させて動作確認を行う。下記の特許文献3は、仮想環境で教示点の作成を行い、作成した教示点を利用して動作プログラムを作成し、ロボットの動作軌道を仮想環境で再生することで、ロボットの動作と干渉の状態を確認できる表示装置、および教示点作成方法を開示している。 Therefore, in recent years, a configuration has been proposed in which an information processing apparatus that is used offline can be taught and checked operations offline. For example, instead of using the created teaching data to operate the actual machine, trajectory calculation and 3D model rendering based on the teaching data are performed, and the virtual display robot is operated on the display screen to check the operation. The following patent document 3 creates teaching points in a virtual environment, creates a motion program using the created teaching points, and reproduces the motion trajectory of the robot in the virtual environment, thereby interfering with the motion and interference of the robot. A display device for confirming the state and a teaching point creation method are disclosed.

特開平8-328637号公報JP-A-8-328637 特開2010-188485号公報JP 2010-188485 A 特開2014-117781号公報JP 2014-117781 A

特許文献1および特許文献2により作成された動作軌道を、特許文献3の仮想環境で再生すれば、実機のロボットを用いずに複雑な位置姿勢の状態を確認できる、と考えられる。 If the motion trajectories created in Patent Documents 1 and 2 are reproduced in the virtual environment of Patent Document 3, it is believed that complex position and orientation states can be confirmed without using a real robot.

しかし、このような仮想環境を利用したロボットの教示(プログラミング)の手法には、いくつかの技術課題がある。 However, there are some technical problems with the method of teaching (programming) a robot using such a virtual environment.

例えば、上記のオフセット演算や複数の異なるロボット座標系を利用した情報処理では、軌道計算によりオフセット後の位置姿勢を求める。この場合、オフセット後の位置姿勢がロボットアームのハードウェア的な制限による可動範囲内であれば、実際にロボットを動かしても問題はない。しかしながら、動作プログラムの作成ミスによって、途中の軌道でロボットの可動範囲外となる場合もある。また、軌道計算エラーが発生すると、発生したエラーを解決しないと、それ以上の確認表示を行うことができない。また、パレタイジング工程において、基準となる教示点を修正すると関連するオフセット後の位置姿勢も変化し、オフセット後の位置姿勢が可動範囲外になる場合がある。 For example, in the above-described offset calculation or information processing using a plurality of different robot coordinate systems, the post-offset position and orientation are obtained by trajectory calculation. In this case, if the position and orientation after the offset are within the movable range due to hardware restrictions of the robot arm, there is no problem even if the robot is actually moved. However, due to a mistake in creating the operation program, there are cases where the robot is out of the movable range in the middle of the trajectory. Further, when a trajectory calculation error occurs, further confirmation display cannot be performed unless the error that has occurred is resolved. Further, in the palletizing process, if the reference teaching point is corrected, the position and orientation after the offset also change, and the position and orientation after the offset may be out of the movable range.

しかし、従来技術では、オフセット入力によって位置姿勢データを変更したり新たに生成したりする場合のエラー処理が充分に行えない問題があった。例えば、従来のロボット制御データ(教示データ)に係る情報処理では、例えば位置姿勢データは、次々とロボットの基準部位を移動させる時系列に沿って配置された単なるフラットなデータリストとして記憶装置に格納されることが多い。ところが、実際のロボット制御データ(教示データ)では、ある特定の教示点の位置姿勢データの変更が、他の1ないし複数の教示点の位置姿勢データに影響を与える関係となっていることがある。例えば、パレタイジングの基準教示点と、オフセットを介して関係づけられた他の教示点の関係はその一例である。 However, in the conventional technology, there is a problem that error processing cannot be sufficiently performed when position and orientation data are changed or newly generated by offset input. For example, in conventional information processing related to robot control data (teaching data), for example, position and orientation data is stored in a storage device as a simple flat data list arranged along the time series for moving the reference parts of the robot one after another. It is often done. However, in actual robot control data (teaching data), a change in the position/orientation data of a specific teaching point may affect the position/orientation data of one or more other teaching points. . For example, the relationship between a reference teaching point for palletizing and another teaching point related via an offset is one example.

従来技術では、位置姿勢データが単なるフラットなデータリストとして格納されることが多く、このため特定の教示点の位置姿勢データの変更が他の位置姿勢データのどこからどこまでが影響を受けるのかを特定するのは容易ではない。従って、従来のロボット制御データ(教示データ)に係る情報処理では、特定の教示点の位置姿勢データの変更が行われたとしても、軌道計算や動作が可動範囲内にあるか否かのチェック処理を行う範囲を特定するのが容易ではなかった。このため、特定の教示点の位置姿勢データの入力、編集や、修正が行われたとしても、従来では、その変更に関する動作確認表示を直ちに、あるいは充分に実施できていなかった。 In the prior art, position and orientation data is often stored as a simple flat data list, so it is necessary to specify from where to where other position and orientation data are affected by a change in the position and orientation data of a specific teaching point. is not easy. Therefore, in the conventional information processing related to robot control data (teaching data), even if the position and orientation data of a specific teaching point is changed, the trajectory calculation and the checking process of whether or not the motion is within the movable range are performed. It was not easy to specify the extent to which For this reason, even if the position and orientation data of a specific teaching point is input, edited, or corrected, conventionally, it has not been possible to immediately or sufficiently display the operation confirmation regarding the change.

また、軌道計算のエラーチェックに関しても、上記のような教示点(位置姿勢データ)の格納形式によると、例えばユーザが軌道計算すべき格納されている教示点の範囲を指定しないと演算を行えない可能性がある。従来では、この指定範囲に対する軌道計算を行ってようやく軌道計算エラー(例えば特定部位の位置姿勢が可動範囲外となる)が生じるか否かを判定できる。このため、ある特定の教示点の入力、編集、修正が行われたとしても、即座に軌道計算エラーのチェックなどを実施することができず、ユーザは当該の入力、編集、修正のタイミングで軌道計算エラーなどの確認を行うことができなかった。 Also, regarding the error check of the trajectory calculation, according to the storage format of the teaching points (position and posture data) as described above, for example, the calculation cannot be performed unless the user specifies the range of the stored teaching points for which the trajectory should be calculated. there is a possibility. Conventionally, it is possible to determine whether or not a trajectory calculation error (for example, the position and orientation of a specific part is out of the movable range) occurs after the trajectory calculation is performed for this specified range. For this reason, even if a specific teaching point is input, edited, or corrected, it is not possible to immediately check for trajectory calculation errors. It was not possible to check for calculation errors, etc.

本発明の課題は、上記の問題に鑑み、ロボット装置の位置姿勢データの入力、編集、修正などが行われた場合、即座に影響のある位置姿勢データの範囲を特定でき、その範囲にある位置姿勢データの軌道計算などを含むエラーチェックを行えるようにする。そして、教示点に係る位置姿勢データの入力、編集、修正の過程で、例えば仮想表示出力や数値表示によって、実行中の入力、編集、修正の経過をほぼその操作に応じてリアルタイムで確認できるようにする。また、位置姿勢データの入力、編集、修正では、オフセットとなる相対値による位置姿勢データの指定や、複数のロボット座標系から把握の容易なロボット座標系を任意に用いることができるようにする。また、ロボット装置の位置姿勢データを格納するためのデータ構造を改善する。 SUMMARY OF THE INVENTION In view of the above problems, an object of the present invention is to immediately identify a range of position and orientation data that has an effect when position and orientation data of a robot apparatus is input, edited, or corrected, and to determine a position within that range. Enable error checking including trajectory calculation of attitude data. In the process of inputting, editing, and correcting position/orientation data related to teaching points, the process of inputting, editing, and correcting being executed can be checked in real time according to the operation, for example, through virtual display output and numerical display. to In inputting, editing, and correcting the position and orientation data, the position and orientation data can be designated by relative values that are offset, and a robot coordinate system that can be easily grasped from a plurality of robot coordinate systems can be arbitrarily used. Also, the data structure for storing the position and orientation data of the robot apparatus is improved.

本発明の一態様は、仮想的なロボットの所定部位の位置または姿勢を設定する情報処理装置であって、前記仮想的なロボットに関して用いられる、複数の座標系の内から第1座標系を指定する座標系指定手段と、制御部と、を備え、前記制御部は、表示部に、前記第1座標系における前記所定部位の移動に対応する前記所定部位の位置または姿勢に関する第1座標値を表示すると共に、前記第1座標系以外の第2座標系における前記第1座標値に対応する前記所定部位の位置または姿勢に関する第2座標値を表示前記第1座標値を入力する第1入力部と、前記第2座標値を入力する第2入力部とを、表示し、前記第1入力部において前記第1座標値を入力した場合、前記第2座標値の表示を当該入力した前記第1座標値に対応する表示に更新し、前記第2入力部において前記第2座標値を入力した場合、前記第1座標値の表示を当該入力した前記第2座標値に対応する表示に更新する、
ことを特徴とする情報処理装置である。
One aspect of the present invention is an information processing device for setting the position or orientation of a predetermined part of a virtual robot, wherein a first coordinate system is designated from among a plurality of coordinate systems used for the virtual robot. and a control section, wherein the control section displays, on the display section, first coordinate values relating to the position or posture of the predetermined part corresponding to the movement of the predetermined part in the first coordinate system. a second coordinate value related to the position or orientation of the predetermined part corresponding to the first coordinate value in a second coordinate system other than the first coordinate system, and inputting the first coordinate value; An input unit and a second input unit for inputting the second coordinate value are displayed, and when the first coordinate value is input in the first input unit, the display of the second coordinate value is displayed as the input unit. When the display is updated to correspond to the first coordinate value and the second coordinate value is input in the second input unit, the display of the first coordinate value is updated to the display corresponding to the input second coordinate value. do,
An information processing apparatus characterized by:

本発明の別の一態様は、仮想的なロボットの所定部位の位置または姿勢を設定する情報処理方法であって、前記仮想的なロボットに関して用いられる複数の座標系の内から、座標系指定手段により第1座標系の指定を受け付ける受付工程と、前記第1座標系における前記所定部位の移動に対応する前記所定部位の位置または姿勢に関する第1座標値を表示すると共に、前記第1座標系以外の第2座標系における前記第1座標値に対応する前記所定部位の位置または姿勢に関する第2座標値を表示する表示工程と、を実行し、前記表示工程において、表示されている第1入力部に前記第1座標値を入力した場合、前記第2座標値の表示を当該入力した前記第1座標値に対応する表示に更新し、表示されている第2入力部に前記第2座標値を入力した場合、前記第1座標値の表示を当該入力した前記第2座標値に対応する表示に更新する、ことを特徴とする情報処理方法である。 Another aspect of the present invention is an information processing method for setting the position or orientation of a predetermined part of a virtual robot, wherein coordinate system designating means selects a coordinate system from among a plurality of coordinate systems used for the virtual robot. a receiving step of receiving designation of a first coordinate system by, displaying a first coordinate value relating to the position or orientation of the predetermined part corresponding to the movement of the predetermined part in the first coordinate system, and displaying a first coordinate value other than the first coordinate system displaying a second coordinate value related to the position or orientation of the predetermined part corresponding to the first coordinate value in the second coordinate system of the display step, wherein the displayed first input unit , the display of the second coordinate value is updated to display corresponding to the input first coordinate value, and the second coordinate value is input to the displayed second input unit. The information processing method is characterized in that, when input, the display of the first coordinate value is updated to display corresponding to the input second coordinate value.

上記構成によれば、ロボット装置の位置姿勢データの入力、編集、修正などが行われた場合、即座に影響のある位置姿勢データの範囲を特定でき、その範囲にある位置姿勢データの軌道計算などを含むエラーチェックを行えるようになる。また、教示点に係る位置姿勢データの入力、編集、修正の過程で、仮想表示出力や数値表示によって、実行中の入力、編集、修正の経過をほぼその操作に応じてリアルタイムで確認することができ、作業工数の削減が可能となる。また、ロボット装置の複数の位置姿勢データを階層構造データとして記憶させることにより、入力、編集、修正の操作に応じて、関連した位置姿勢データを適切に自動編集することができ、その結果を仮想表示出力や数値表示に適切に反映させることができる。 According to the above configuration, when the position and orientation data of the robot device is input, edited, corrected, etc., the range of the position and orientation data affected can be specified immediately, and the trajectory calculation of the position and orientation data within that range can be performed. You will be able to perform error checking including In addition, in the process of inputting, editing, and correcting position/orientation data related to teaching points, the progress of inputting, editing, and correcting being executed can be checked in real time according to the operation through virtual display output and numerical display. It is possible to reduce the work man-hours. In addition, by storing a plurality of position and orientation data of the robot apparatus as hierarchical structure data, it is possible to appropriately and automatically edit the relevant position and orientation data in response to input, edit, and correction operations, and to visualize the results. It can be appropriately reflected in the display output and numerical display.

本発明の実施例1に係わる表示装置を示した説明図である。1 is an explanatory diagram showing a display device according to Example 1 of the present invention; FIG. 本発明の実施例1に係わるオフライン教示システムのブロック図である。1 is a block diagram of an offline teaching system according to Example 1 of the present invention; FIG. 本発明の実施例1に係わるオフセット教示点の作成を示したフローチャート図である。FIG. 4 is a flow chart diagram showing creation of an offset teaching point according to the first embodiment of the present invention; 本発明の実施例1に係わる仮想環境画面の説明図である。FIG. 4 is an explanatory diagram of a virtual environment screen according to Example 1 of the present invention; 本発明の実施例1に係わるパラメータ設定画面の説明図である。FIG. 4 is an explanatory diagram of a parameter setting screen according to Example 1 of the present invention; 本発明の実施例1に係わる異なるパラメータ設定画面の説明図である。FIG. 5 is an explanatory diagram of a different parameter setting screen according to the first embodiment of the present invention; 本発明の実施例1に係わる管理画面を示した説明図である。FIG. 4 is an explanatory diagram showing a management screen according to Example 1 of the present invention; 本発明の実施例1に係わるエラー画面の説明図である。FIG. 10 is an explanatory diagram of an error screen according to the first embodiment of the present invention; 本発明の実施例1に係わるオフセット教示点の編集処理を示したフローチャート図である。FIG. 5 is a flow chart diagram showing editing processing of an offset teaching point according to the first embodiment of the present invention; 本発明の実施例1に係わる異なるパラメータ設定画面を示したフローチャート図である。It is the flowchart figure which showed the different parameter setting screen concerning Example 1 of this invention. 本発明の実施例2に係わるノード管理画面を示した説明図である。FIG. 11 is an explanatory diagram showing a node management screen according to Example 2 of the present invention; 本発明の実施例2に係わるオフセット教示点の編集処理を示したフローチャート図である。FIG. 10 is a flow chart diagram showing editing processing of an offset teaching point according to the second embodiment of the present invention; 本発明の実施例2に係わるワークの配置変更処理を示したフローチャート図である。FIG. 10 is a flow chart diagram showing work placement change processing according to the second embodiment of the present invention. 本発明の実施例2に係わる仮想環境画面の説明図である。FIG. 10 is an explanatory diagram of a virtual environment screen according to Example 2 of the present invention; 本発明の実施例2に係わる仮想環境画面の説明図である。FIG. 10 is an explanatory diagram of a virtual environment screen according to Example 2 of the present invention; 本発明の実施例2に係わるパラメータ設定画面の説明図である。FIG. 11 is an explanatory diagram of a parameter setting screen according to Example 2 of the present invention; 本発明の実施例3に係わるオフセット教示点の編集処理を示したフローチャート図である。FIG. 11 is a flow chart diagram showing editing processing of an offset teaching point according to the third embodiment of the present invention; 本発明の実施例3に係わる仮想環境画面の説明図である。FIG. 11 is an explanatory diagram of a virtual environment screen according to Example 3 of the present invention; 本発明の実施例3に係わるパラメータ設定画面の説明図である。FIG. 11 is an explanatory diagram of a parameter setting screen according to Example 3 of the present invention; 本発明の実施例3に係わるパラメータ設定画面の説明図である。FIG. 11 is an explanatory diagram of a parameter setting screen according to Example 3 of the present invention; 本発明の実施例4に係わるオフセット教示点の編集処理を示したフローチャート図である。FIG. 11 is a flow chart diagram showing editing processing of an offset teaching point according to Example 4 of the present invention. 本発明の実施例4に係わる仮想環境画面の説明図である。FIG. 11 is an explanatory diagram of a virtual environment screen according to Example 4 of the present invention; 本発明の実施例5に係わるオフセット教示点の編集処理を示したフローチャート図である。FIG. 11 is a flow chart diagram showing editing processing of an offset teaching point according to Example 5 of the present invention. 本発明の実施例5に係わる仮想環境画面を示した説明図である。FIG. 11 is an explanatory diagram showing a virtual environment screen according to Example 5 of the present invention; 本発明の実施例5に係わるパラメータ設定画面の説明図である。FIG. 13 is an explanatory diagram of a parameter setting screen according to Example 5 of the present invention;

以下、添付図面に示す実施例を参照して本発明を実施するための形態につき説明する。なお、以下に示す実施例はあくまでも一例であり、例えば細部の構成については本発明の趣旨を逸脱しない範囲において当業者が適宜変更することができる。また、本実施形態で取り上げる数値は、参考数値の例示に過ぎない。 DETAILED DESCRIPTION OF THE INVENTION Embodiments for carrying out the present invention will now be described with reference to the embodiments shown in the accompanying drawings. It should be noted that the embodiment shown below is merely an example, and, for example, details of the configuration can be changed as appropriate by those skilled in the art without departing from the scope of the present invention. Further, the numerical values taken up in the present embodiment are merely examples of reference numerical values.

以下、図1から図10を参照して、本発明を採用したロボット装置の教示(プログラミング)用の情報処理装置および情報処理方法の一実施例につき説明する。 An embodiment of an information processing apparatus and information processing method for teaching (programming) a robot apparatus employing the present invention will be described below with reference to FIGS. 1 to 10. FIG.

図1および図2は、本実施例に係る情報処理装置Aの構成を示している。図1に示すように、本実施例の情報処理装置Aは、例えばパソコン(パーソナルコンピュータ)Bに、ユーザーインターフェースとして表示装置Cと、操作入力部Dを装着して構成することができる。操作入力部Dには、マウスやトラックパッドその他のポインティングデバイス、およびキーボードなどの操作デバイスを用いることができる。 1 and 2 show the configuration of an information processing apparatus A according to this embodiment. As shown in FIG. 1, the information processing apparatus A of this embodiment can be configured by attaching a display device C and an operation input unit D as a user interface to a personal computer (PC) B, for example. For the operation input unit D, a mouse, a trackpad, other pointing devices, and a keyboard, etc., can be used.

表示装置Cは、LCD(あるいは他の表示方式によるディスプレイ装置)などの表示装置により構成される。表示装置Cは、その表示面にいわゆるタッチパネルを積層して構成することもできる。その場合には、操作入力部Dのポインティングデバイス、やキーボードなどの操作デバイスと同等の入力操作をタッチパネルにより行うことができ、場合によっては操作入力部Dを省略した構成とすることもできる。 The display device C is configured by a display device such as an LCD (or a display device using another display method). The display device C can also be configured by laminating a so-called touch panel on its display surface. In that case, the touch panel can be used to perform input operations equivalent to those of the pointing device of the operation input unit D or an operation device such as a keyboard, and depending on the situation, the operation input unit D can be omitted.

本実施例の情報処理装置Aは、実際にロボット装置と接続してこれを動作させるようなオンライン環境よりも、主にオフライン環境でロボット装置の教示データの入力、編集、変更などに用いることができるよう構成される。本実施例の情報処理装置Aはロボット装置の教示データの入力、編集、変更の操作は、操作入力部Dによって行えるよう構成され、表示装置Cには、例えば図1に示すようなオフライン教示システムの表示画面Eを表示させることができる。 The information processing apparatus A of this embodiment can be used mainly in an off-line environment for inputting, editing, and changing teaching data of the robot apparatus, rather than an on-line environment in which the robot apparatus is actually connected and operated. configured to allow The information processing apparatus A of this embodiment is configured so that input, edit, and change operations of teaching data for the robot apparatus can be performed by an operation input unit D, and the display device C includes, for example, an off-line teaching system as shown in FIG. can be displayed.

図1の表示画面Eは、少なくとも仮想環境画面10、およびパラメータ設定画面20、および管理画面40を含む構成となっている。 The display screen E of FIG. 1 includes at least a virtual environment screen 10, a parameter setting screen 20, and a management screen 40. FIG.

仮想環境画面10、パラメータ設定画面20、管理画面40はグラフィックユーザインターフェース(GUI)として構成することができる。その場合、操作入力部Dのマウスなどのポインティングデバイス(ないし上記のタッチパネル)により、表示画面Eを構成する表示オブジェクト(メニュー、数値や文字の入力フィールド、ロボットアームの仮想表示など)を操作できるよう構成される。このようなGUI環境の実装手法の細部は概ね公知であるため、ここでは詳細な説明は省略する。 The virtual environment screen 10, the parameter setting screen 20, and the management screen 40 can be configured as a graphic user interface (GUI). In that case, a pointing device such as a mouse (or the above-mentioned touch panel) of the operation input unit D can be used to operate the display objects (menus, input fields for numerical values and characters, virtual display of the robot arm, etc.) that make up the display screen E. Configured. Since details of such a GUI environment implementation technique are generally known, detailed description thereof is omitted here.

仮想環境画面10(仮想環境表示部)には、本装置でプログラム(教示)する実機のロボット装置と同等の配置環境を再現した仮想環境を表示する。例えば、仮想環境画面10は、位置姿勢データにより特定されるロボット101装置の状態を3DCADモデルのような3Dモデル表現により仮想表示する。その場合、後述のCPU(33)の表示装置Cを制御する表示制御機能によって、例えば、ロボット101の作動環境に擬した仮想空間中に位置姿勢データにより特定される位置姿勢にあるロボット101の3D画像をレンダリングして仮想表示を行う。このように位置姿勢データからロボット101を3DCADモデル表現などにより仮想表示するための(画像)表示制御については公知であるから、ここでは詳細な説明は省略する。 A virtual environment screen 10 (virtual environment display unit) displays a virtual environment that reproduces a layout environment equivalent to that of a real robot device programmed (teached) by this device. For example, the virtual environment screen 10 virtually displays the state of the robot 101 specified by the position/orientation data in a 3D model representation such as a 3D CAD model. In this case, a 3D image of the robot 101 in a position and orientation specified by the position and orientation data in a virtual space simulating the working environment of the robot 101 is displayed by a display control function for controlling the display device C of the CPU (33), which will be described later. Render the image for a virtual display. Since the (image) display control for virtually displaying the robot 101 from the position and orientation data by 3D CAD model representation or the like is well known, a detailed description thereof will be omitted here.

図1の場合、仮想環境画面10には本装置でプログラム(教示)する実機のロボット装置に相当するロボット101と、ロボット101の先端に取り付けたツール102、ワーク103が配置され表示されている。本実施例では、ユーザ(作業者)がロボットプログラムや教示データ(位置姿勢データ)に対する入力、編集などを行った場合、その変更に応じて仮想環境画面10の仮想環境の表示を更新する。これにより、ユーザ(作業者)は、仮想環境画面10の仮想環境の表示を介して容易に入力や編集の内容を確認することができる。 In the case of FIG. 1, on the virtual environment screen 10, a robot 101 corresponding to a real robot device to be programmed (teached) by this device, a tool 102 attached to the tip of the robot 101, and a workpiece 103 are arranged and displayed. In this embodiment, when a user (operator) inputs or edits a robot program or teaching data (position/orientation data), the display of the virtual environment on the virtual environment screen 10 is updated according to the change. As a result, the user (operator) can easily confirm the contents of input and editing through the display of the virtual environment on the virtual environment screen 10 .

多くのロボット装置では、位置姿勢データの表現に座標データが用いられる。この座標データの表現には、いくつかの異なる座標系における座標データが用いられる。例えば、本装置で取り扱うロボット101では、ベース座標系104(絶対座標系100)、およびツール座標系105が用いられる。本実施例では、ロボット101のベース座標系104は、仮想環境の絶対座標系100と一致した位置に配置されている。また、ツール102の先端にはツール座標系105が存在している。これらの座標系は、3次元座標系であり、仮想環境画面10中では、必要に応じて図示のように3軸(X、Y、Z)の座標軸を表示することができる。 Many robot devices use coordinate data to express position and orientation data. Coordinate data in several different coordinate systems are used to express this coordinate data. For example, in a robot 101 handled by this apparatus, a base coordinate system 104 (absolute coordinate system 100) and a tool coordinate system 105 are used. In this embodiment, the base coordinate system 104 of the robot 101 is arranged at a position coinciding with the absolute coordinate system 100 of the virtual environment. A tool coordinate system 105 exists at the tip of the tool 102 . These coordinate systems are three-dimensional coordinate systems, and in the virtual environment screen 10, three coordinate axes (X, Y, Z) can be displayed as shown in the drawing as needed.

図1に例示した仮想環境画面10では、ワーク103の上空に基準となる教示点106が表示されている。この教示点106は、例えば既に入力済みの教示点である。ここで、例えばツール102を教示点106から下降させてワーク103に対してアプローチさせる動作を考える。 In the virtual environment screen 10 illustrated in FIG. 1, a reference teaching point 106 is displayed above the workpiece 103 . This teaching point 106 is, for example, an already input teaching point. Consider, for example, the operation of lowering the tool 102 from the teaching point 106 to approach the workpiece 103 .

この場合、例えば基準となる教示点106よりオフセットとなる相対値を用いて設定したオフセット教示点107をワーク103の上面に教示する手法が用いられる。この場合、教示点106に対して用いられるオフセットの相対値は、例えばZ軸方向の移動量(距離)などの数値によって表現される。なお、図1の仮想環境画面10では、ロボット101の位置姿勢は、その所定部位(例えばツール102の把持中心やツール装着面の中心など)が基準となる教示点106と一致した時の位置姿勢が表示されている。 In this case, for example, a technique is used in which an offset teaching point 107 set using a relative value offset from a reference teaching point 106 is taught on the upper surface of the workpiece 103 . In this case, the relative value of the offset used for the teaching point 106 is represented by a numerical value such as the amount of movement (distance) in the Z-axis direction. Note that in the virtual environment screen 10 of FIG. 1, the position and orientation of the robot 101 is the position and orientation when its predetermined part (for example, the gripping center of the tool 102, the center of the tool mounting surface, etc.) coincides with the teaching point 106 serving as a reference. is displayed.

さらに、表示装置Cの表示画面E中には、パラメータ設定画面20を表示させている。本実施例においては、パラメータ設定画面20は、位置姿勢データの数値表示を行うパラメータ表示部の機能と、GUI操作によってその値を設定するパラメータ設定部の機能を兼ねている。このパラメータ設定画面20には、現在のロボット101の位置姿勢を表したパラメータが数値表現の形式でそれぞれの表示位置に表示されている。パラメータ設定画面20の各パラメータに相当する数値の表示位置は、例えば数値(文字)入力のためのいわゆる入力ボックスとして構成される。これらのパラメータの入力ボックスの数値(あるいは文字)は、操作入力部Dを操作することにより、新たに入力したり、既に入力されている値を変更したりすることができるよう構成される。なお、このような入力ボックスを用いたユーザーインターフェースを実現するためのハードウェアやソフトウェアの細部については公知であり、ここでは詳細な説明は省略する。 Furthermore, in the display screen E of the display device C, a parameter setting screen 20 is displayed. In this embodiment, the parameter setting screen 20 has both the function of a parameter display section for numerically displaying position and orientation data and the function of a parameter setting section for setting the values by GUI operation. On this parameter setting screen 20, parameters representing the current position and orientation of the robot 101 are displayed at respective display positions in the form of numerical expressions. The display position of the numerical value corresponding to each parameter on the parameter setting screen 20 is configured, for example, as a so-called input box for inputting numerical values (characters). Numerical values (or characters) in the input boxes for these parameters are configured so that they can be newly input or can be changed from values that have already been input by operating the operation input unit D. FIG. Details of hardware and software for realizing a user interface using such an input box are well known, and detailed description thereof will be omitted here.

ロボット装置(ロボット101)を制御する教示データ(教示点や位置姿勢データ数値データの実体)や、3Dモデル表現などにより仮想環境画面10中にモデリングないしレンダリングするためのモデル情報は、階層データの形式で格納、管理する。 Teaching data for controlling the robot device (robot 101) (entities of teaching points and position/orientation data numerical data) and model information for modeling or rendering in the virtual environment screen 10 by 3D model representation etc. are in the form of hierarchical data. stored and managed by

記憶装置35のRAM35bや外部記憶装置35cは、複数の位置姿勢データを格納する記憶手段として用いられる。例えば、ロボット101の異なる部位がロボット装置の構造によって特定される特定の依存関係にある場合、異なる部位に対応する複数の位置姿勢データは記憶装置35に階層構造データとして記憶する。 The RAM 35b of the storage device 35 and the external storage device 35c are used as storage means for storing a plurality of position and orientation data. For example, if different parts of the robot 101 have specific dependencies specified by the structure of the robot apparatus, a plurality of position/orientation data corresponding to the different parts are stored in the storage device 35 as hierarchical structure data.

この階層構造データの構造や内容については、例えば以下の管理画面40(管理表示部)の説明を通して理解されよう。 The structure and contents of this hierarchical structure data will be understood, for example, through the following description of the management screen 40 (management display section).

即ち、本実施例では、表示装置Cの表示画面E中には、教示データ(教示点や位置姿勢データ)やモデル情報のデータ構造を表示するための管理画面40(管理表示部)を表示させる。管理画面40には、仮想環境画面10で表示されているモデル情報と教示点情報が一括でノード管理され、その状態がいわゆる樹形図の形式で表示されている。 That is, in this embodiment, the display screen E of the display device C displays a management screen 40 (management display section) for displaying the data structure of teaching data (teaching points and position/orientation data) and model information. . On the management screen 40, the model information and teaching point information displayed on the virtual environment screen 10 are collectively node-managed, and the state thereof is displayed in the form of a so-called tree diagram.

本実施例における教示データやモデル情報に関するノード管理では、一番上の根のモデル情報を絶対座標系100(ROOT)とし、絶対座標系(100)から枝と階層構造で複数のモデル情報の関連を示すデータ構造を用いる。本実施例の位置姿勢データのデータ構造においては、根に近いモデルを親のモデル、葉に近いモデルを子のモデルと呼ぶ。 In node management related to teaching data and model information in this embodiment, the model information of the top root is set to the absolute coordinate system 100 (ROOT), and from the absolute coordinate system (100), branches and hierarchical structures are used to associate a plurality of model information. Use a data structure that indicates In the data structure of the position and orientation data of this embodiment, a model close to the root is called a parent model, and a model close to the leaf is called a child model.

関連付けとして管理する情報は、親と子のモデル情報の関係性、親から子までのモデルの位置姿勢となる相対値情報を保有しているものとする。だたし、本実施例の教示データやモデル情報に関するノード管理で管理する情報は相対値情報に限定されない。例えば、根から子までのモデルの位置姿勢に相当する絶対値情報を格納するようにしても良い。 It is assumed that the information managed as an association holds the relationship between the parent and child model information and the relative value information that is the position and orientation of the model from the parent to the child. However, information managed by node management related to teaching data and model information in this embodiment is not limited to relative value information. For example, absolute value information corresponding to the position and orientation of the model from the root to the child may be stored.

本実施例における教示データやモデル情報を管理するための(階層)ノード形式のデータ格納形式には、各ノードのデータを例えばアドレスポインタなどを介して関係づけた上でメモリ中に格納する、例えばリンクトリストの形式などを利用できる。あるいは、教示データやモデル情報をHDDやSSDのような外部記憶装置上のファイルシステムに格納する場合には、各種リレーショナルデータベースシステムにおけるデータ格納形式を利用してもよい。 In the data storage format of (hierarchical) node format for managing teaching data and model information in this embodiment, the data of each node are associated with each other via address pointers, for example, and then stored in memory. You can use the linked list format. Alternatively, when storing teaching data and model information in a file system on an external storage device such as an HDD or SSD, data storage formats in various relational database systems may be used.

なお、本明細書を通して、管理画面40の表示は、記憶装置35上に格納された教示データ(位置姿勢データ)のノードから成る階層的なツリー構造を視覚的に表示したものとして取り扱う。また、同時に管理画面40の図示は、記憶装置35上に格納された上記ツリー構造の教示データ(位置姿勢データ)のメモリマップ表示と考えてもよい。 Throughout this specification, the display of the management screen 40 is treated as a visual display of a hierarchical tree structure composed of nodes of teaching data (position and orientation data) stored on the storage device 35 . At the same time, the illustration of the management screen 40 may be considered as a memory map display of the tree-structured teaching data (position and orientation data) stored on the storage device 35 .

上記のようなノード管理によれば、親のモデルの位置姿勢となる相対値情報を変更した場合、子のモデルは、親から子までのモデルの位置姿勢に相当する相対値情報を保有しているため、親のモデルに従って追従することができる。 According to the node management described above, when the relative value information that is the position and orientation of the parent model is changed, the child model retains the relative value information that corresponds to the position and orientation of the models from the parent to the child. Therefore, it can follow the parent's model.

図1の管理画面40に表示しているデータ構造では、絶対座標系100(ROOT)の子のモデル情報の下位にロボット101(ROBOT)とワーク103(Work)が位置している。さらに、ロボット101の子のモデル情報に、ツール102(Tool)と、ツール座標系105(TCP)が位置している。さらに、ロボット101の子のモデルには教示点が関連づけられる。例えばロボット101の子のモデルの1つとして、基準となる教示点106(P001)が関連づけられている。さらに、基準となる教示点106の子のモデルには、オフセット教示点107(P100)が関連づけられている。 In the data structure displayed on the management screen 40 of FIG. 1, the robot 101 (ROBOT) and the work 103 (Work) are positioned below the child model information of the absolute coordinate system 100 (ROOT). Furthermore, in the child model information of the robot 101, a tool 102 (Tool) and a tool coordinate system 105 (TCP) are located. Further, a child model of robot 101 is associated with a teaching point. For example, one child model of the robot 101 is associated with the reference teaching point 106 (P001). Further, the child model of the teaching point 106 serving as a reference is associated with the offset teaching point 107 (P100).

次に、図1の情報処理装置Aのパソコン(パーソナルコンピュータ)Bにより構成された制御系の構成を図2に示す。図2に示すように、図1の情報処理装置Aを構成するパソコンBは、ハードウェア的には、CPU33と、ROM35a、RAM35b、外部記憶装置35cなどから成る記憶装置35を含む。さらに、パソコンBは、操作入力部Dと接続するためのインターフェース32a、表示装置Cと接続するためのインターフェース32b、外部装置と例えばファイルFの形式でデータを送受信するためのインターフェース36を含む。これらのインターフェースは、例えば各種シリアルバスやパラレルバス、ネットワークインターフェースなどから構成される。 Next, FIG. 2 shows the configuration of the control system constituted by the personal computer (PC) B of the information processing apparatus A shown in FIG. As shown in FIG. 2, the personal computer B that constitutes the information processing apparatus A of FIG. 1 includes, in terms of hardware, a CPU 33, a storage device 35 comprising a ROM 35a, a RAM 35b, an external storage device 35c, and the like. Further, the personal computer B includes an interface 32a for connecting to the operation input unit D, an interface 32b for connecting to the display device C, and an interface 36 for transmitting and receiving data in the form of a file F, for example, with an external device. These interfaces are composed of, for example, various serial buses, parallel buses, network interfaces, and the like.

図2では、CPU33とともに計算部34が示してあるが、この計算部34は、実際にはCPU33が後述の制御演算を行うための制御プログラムを実行することにより実現される。表示装置Cには、上述の仮想環境画面10やパラメータ設定画面20、管理画面40などから構成されるGUI形式の表示画面Eを表示する。操作入力部Dは、表示装置Cの表示画面EとともにGUI(グラフィカルユーザーインターフェース)を構成し、操作入力部DのポインティングデバイスやキーボードによるユーザのGUI操作を受けつける。 Although FIG. 2 shows the calculation unit 34 together with the CPU 33, the calculation unit 34 is actually implemented by the CPU 33 executing a control program for performing control calculations, which will be described later. The display device C displays a GUI format display screen E including the virtual environment screen 10, the parameter setting screen 20, the management screen 40, and the like. The operation input unit D constitutes a GUI (graphical user interface) together with the display screen E of the display device C, and receives GUI operations by the user using the pointing device of the operation input unit D or the keyboard.

CPU33は情報処理装置A全体のシステム制御を行う。CPU33は、操作入力部Dで行われた入力、編集操作に基づき、計算部34の制御演算を行う。この計算部34の制御演算によって、表示装置Cの表示を更新するための表示制御情報が生成されるとともに、記憶装置35に格納された教示データおよびモデル情報の更新を行う。 The CPU 33 performs system control of the information processing apparatus A as a whole. The CPU 33 performs control calculations for the calculation unit 34 based on the input and editing operations performed by the operation input unit D. FIG. Display control information for updating the display of the display device C is generated by the control calculation of the calculation unit 34, and teaching data and model information stored in the storage device 35 are updated.

記憶装置35は、仮想環境画面10に表示されている3DCADモデル情報や配置環境情報、教示データなどを格納する。特に、教示データやモデル情報は、上記の(階層)ノード形式で格納される。記憶装置35に格納された各種データは、CPU33からの要求に応じて出力され、また、CPU33からの要求に応じて更新される。 The storage device 35 stores 3D CAD model information, layout environment information, teaching data, and the like displayed on the virtual environment screen 10 . In particular, teaching data and model information are stored in the above (hierarchical) node format. Various data stored in the storage device 35 are output in response to requests from the CPU 33 and updated in response to requests from the CPU 33 .

また、外部装置からの要求、あるいは操作入力部Dにおける特定の操作に応じて、CPU33は記憶装置35に保存された各種データをファイルFの形式でインターフェース36から送信させることができる。また、インターフェース36を介して外部からファイルFを必要に応じて読み込むこともできる。例えば、情報処理装置Aの起動時やレストア(復元)処理では、外部装置(例えば外部のHDD、SDD、NASなどの外部記憶装置)から過去に出力したファイルFを読込み、記憶装置35を更新し、以前の記憶の状態を再現することができる。 In addition, the CPU 33 can transmit various data stored in the storage device 35 in the form of a file F from the interface 36 in response to a request from an external device or a specific operation on the operation input unit D. Also, the file F can be read from outside via the interface 36 as required. For example, when the information processing apparatus A is started or during restoration processing, the file F output in the past is read from an external device (for example, an external storage device such as an external HDD, SDD, or NAS), and the storage device 35 is updated. , can reproduce the state of the previous memory.

なお、本実施例において、ロボット101の教示データやモデル情報を格納する記憶装置35の記憶領域は任意であり、例えばRAM35b上の所定領域や、外部記憶装置35cの(例えば所定ファイルに対応する)記憶領域を用いることができる。 In this embodiment, the storage area of the storage device 35 for storing teaching data and model information of the robot 101 is arbitrary. A storage area can be used.

以上が、情報処理装置Aの全体構成の一例である。なお、以上では、例えばオフライン教示に適したシステムの例として、パソコンBのようなハードウェア構成を例示した。しかしながら、情報処理装置Aはオフライン教示システムに限定されることなく、ロボット装置とともに現場に設置されるティーチングペンダントなどのハードウェア構成であっても構わない。その場合、ティーチングペンダントの表示装置が上述と同等の仮想環境画面を表示できるよう構成されていれば、本実施例と同等の構成を実施することができる。 An example of the overall configuration of the information processing apparatus A has been described above. In the above description, the hardware configuration of the personal computer B has been exemplified as an example of a system suitable for off-line teaching. However, the information processing device A is not limited to the offline teaching system, and may be a hardware configuration such as a teaching pendant installed on site together with the robot device. In that case, if the display device of the teaching pendant is configured to display a virtual environment screen equivalent to that described above, a configuration equivalent to that of this embodiment can be implemented.

次に、本実施例における作成および編集処理の一例として、上記構成におけるオフセット教示点107の作成および編集処理を説明する。オフセット教示点107の作成・編集処理については、操作入力部Dおよび表示装置CのGUIで行われた操作に応じて異なる処理と表示を行う。 Next, as an example of creation and editing processing in this embodiment, creation and editing processing of the offset teaching point 107 in the above configuration will be described. Regarding the creation/editing processing of the offset teaching point 107, different processing and display are performed according to the operation performed on the GUI of the operation input unit D and the display device C. FIG.

例えば、この種の情報処理装置Aでは、図1のオフセット教示点107に関しては、位置姿勢データを異なる座標系における座標値を用いた入力ないし編集に対応できる必要がある。また、一旦、位置姿勢データを入力された後、ユーザがパラメータ表示に用いる座標系を切り替えた場合や、ユーザが元の基準となる教示点106の位置姿勢データを編集した場合にも対応できる必要がある。 For example, the information processing apparatus A of this type must be capable of inputting or editing position and orientation data using coordinate values in different coordinate systems with respect to the offset teaching point 107 in FIG. In addition, it is necessary to be able to cope with a case where the user switches the coordinate system used for parameter display after once inputting the position and orientation data, or a case where the user edits the position and orientation data of the teaching point 106 which is the original reference. There is

そこで、以下では、オフセット教示点107の作成・編集処理については、次の4つのケースについて説明する。これらは、「ツール座標系105を選択した場合」、「ベース座標系104を選択した場合」、「座標系を切り替えた場合」、「基準となる教示点106を編集した場合」の作成・編集処理である。 Therefore, below, the following four cases will be described for the creation/editing process of the offset teaching point 107 . These are the creation/editing of "when the tool coordinate system 105 is selected", "when the base coordinate system 104 is selected", "when the coordinate system is switched", and "when the reference teaching point 106 is edited". processing.

(ツール座標系を用いたオフセット教示点の作成)
まず、1つ目のケース、ツール座標系105を選択してオフセット教示点107の作成手順と処理につき、図3から図5、図7から図8を参照して説明する。この例では、基準となる教示点106よりZ軸方向に「30mm」オフセットしたオフセット教示点107を作成する。
(Creation of offset teaching point using tool coordinate system)
First, the procedure and processing for selecting the tool coordinate system 105 and creating the offset teaching point 107 in the first case will be described with reference to FIGS. In this example, an offset teaching point 107 that is offset by 30 mm in the Z-axis direction from a reference teaching point 106 is created.

図3は、オフセット教示点107を新規作成した場合のCPU33が実行する制御手順の流れを示している。図示の手順はCPU33が実行可能なプログラムの形式で、例えば記憶装置35のROM35aや外部記憶装置35cに格納しておくことができる。この点については、後述の他のフローチャート図に示した制御手順でも同様である。 FIG. 3 shows the flow of the control procedure executed by the CPU 33 when the offset teaching point 107 is newly created. The illustrated procedure can be stored in the form of a program executable by the CPU 33, for example, in the ROM 35a of the storage device 35 or the external storage device 35c. This point also applies to control procedures shown in other flowcharts to be described later.

なお、ROM35aは、後述のような情報処理プログラムを記憶するための、コンピュータ(CPU33)により読み取り可能な記録媒体に相当する。CPU33は、例えばROM35aに格納された情報処理プログラムを実行することにより、後述のようなトルク制御を含むロボット制御を実行する。なお、ROM35aの一部は、E(E)PROMのような書き換え可能な不揮発領域により構成できる。その場合、当該の不揮発領域を不図示のフラッシュメモリや光ディスクのようなコンピュータ読み取り可能なメモリデバイス(記録媒体)で構成することもでき、例えばそのメモリデバイスの交換により情報処理プログラムのインストールや更新が可能である。また、ネットワークなどを介して取得した情報処理プログラムを新たに上記書き換え可能な不揮発領域にインストールすることもできる。また、上記書き換え可能な不揮発領域に格納されている情報処理プログラムは、上記コンピュータ読み取り可能な記録媒体や、ネットワークなどを介して取得したデータによって更新することもできる。 The ROM 35a corresponds to a computer (CPU 33)-readable recording medium for storing an information processing program described later. The CPU 33 executes robot control including torque control as described later by executing an information processing program stored in the ROM 35a, for example. A part of the ROM 35a can be composed of a rewritable non-volatile area such as an E(E)PROM. In that case, the non-volatile area can be composed of a computer-readable memory device (recording medium) such as a flash memory or an optical disk (not shown). For example, by replacing the memory device, the information processing program can be installed or updated. It is possible. Also, an information processing program obtained via a network or the like can be newly installed in the rewritable nonvolatile area. The information processing program stored in the rewritable non-volatile area can also be updated by data acquired via the computer-readable recording medium or a network.

図4(a)~(d)はオフセット教示点107の作成・編集処理に係わるロボット101の仮想環境画面10における表示状態を示している。図1では前方からの斜視図のような表示であるが、図4(a)~(d)の仮想環境画面10の表示では理解を容易にするため、側方からの表示を採用している。 FIGS. 4A to 4D show display states on the virtual environment screen 10 of the robot 101 related to the creation/editing process of the offset teaching point 107. FIG. Although FIG. 1 shows a perspective view from the front, the display of the virtual environment screen 10 shown in FIGS. .

図4(a)は、ロボット101の初期姿勢であり、図3のオフセット教示点107の作成を行う処理の開始時の位置姿勢を示している。なお、基準となる教示点106は、例えばロボット101のベース座標系104からの相対値により表現された教示点であり、ここでは既に作成されている状態とする。 FIG. 4A shows the initial posture of the robot 101, which is the position and posture at the start of processing for creating the offset teaching point 107 in FIG. Note that the reference teaching point 106 is, for example, a teaching point represented by a relative value from the base coordinate system 104 of the robot 101, and is assumed to have already been created here.

また、図5(a)~(d)(後述の図6(a)~(d)も同様)は、オフセット教示点107の作成・編集処理中のGUI、特にパラメータ設定画面20における入力、表示の状態を示している。 5(a) to (d) (similarly to FIGS. 6(a) to (d) described later) show the GUI during the creation/editing process of the offset teaching point 107, especially the input and display on the parameter setting screen 20. state.

図3の処理手順において、ステップS0では、操作入力部Dで所定の操作を行い、新規にオフセット教示点107を作成する処理を指定する。このオフセット教示点(107)の作成では、図5(a)~(d)に示すようなパラメータ設定画面20が用いられる。 In the processing procedure of FIG. 3, at step S0, a predetermined operation is performed on the operation input unit D to designate processing for creating a new offset teaching point 107. In the processing procedure shown in FIG. A parameter setting screen 20 as shown in FIGS. 5(a) to 5(d) is used to create the offset teaching point (107).

図5(a)~(d)のパラメータ設定画面20では、絶対値設定部201と、相対値設定部202と、教示点設定部203と、座標系選択部204を表示している。図5(a)の初期状態では、新規にオフセット教示点を作成する操作をまだ行っておらず、まだパラメータは何も入力されていない。 5A to 5D, the parameter setting screen 20 displays an absolute value setting section 201, a relative value setting section 202, a teaching point setting section 203, and a coordinate system selection section 204. FIG. In the initial state of FIG. 5(a), the operation of creating a new offset teaching point has not yet been performed, and no parameters have been input yet.

絶対値設定部201は、例えば絶対座標系(例えばベース座標系104)における絶対座標値の入力に用いられる。また、相対値設定部202は、例えば相対座標系(例えばツール座標系105)における相対座標値の入力に用いられる。座標系選択部204は、パラメータ設定画面20で位置姿勢データに対応する座標値を表示する場合に用いる座標系としてロボット101に関して用いられる異なる座標系の1つを指定するための座標系指定手段を構成する。 The absolute value setting unit 201 is used, for example, to input absolute coordinate values in an absolute coordinate system (for example, the base coordinate system 104). Also, the relative value setting unit 202 is used, for example, to input relative coordinate values in a relative coordinate system (for example, the tool coordinate system 105). The coordinate system selection unit 204 is coordinate system specification means for specifying one of the different coordinate systems used for the robot 101 as the coordinate system used when displaying the coordinate values corresponding to the position and orientation data on the parameter setting screen 20 . Configure.

オフセット教示点の新規作成では、基準となる教示点(106)を設定する必要がある。基準となる教示点106を設定する(教示点設定手段、図3のステップS1)場合、図5(a)のようにして、基準となる教示点106の設定操作を行う。 In creating a new offset teaching point, it is necessary to set a teaching point (106) that serves as a reference. When setting the teaching point 106 to be the reference (teaching point setting means, step S1 in FIG. 3), the setting operation of the teaching point 106 to be the reference is performed as shown in FIG. 5(a).

例えば、ユーザは図5(a)の教示点設定部203を操作入力部Dのマウスのカーソル205でクリックする。これに応じて、CPU33は、表示装置Cを制御して、パラメータ設定画面20の教示点設定部203を例えばプルダウンメニューのように用いて選択可能な教示点リスト206を表示させる。ユーザ(作業者)は、この教示点リスト206より、基準となる教示点106をマウスクリックなどにより選択することができる。 For example, the user clicks the teaching point setting section 203 in FIG. In response, the CPU 33 controls the display device C to display a selectable teaching point list 206 using the teaching point setting section 203 of the parameter setting screen 20 like a pull-down menu, for example. A user (operator) can select a reference taught point 106 from the taught point list 206 by clicking a mouse or the like.

このようにして基準となる教示点106の選択が完了すると、CPU33は記憶装置35に記録された選択した教示点「P001」のパラメータを読み出し、読み出したパラメータに基づき表示装置Cの表示画面Eを更新する。具体的には、教示点リスト206の「基準」の表示を、図5(b)のように教示点「P001」に対応する表示に切り替える。 When the selection of the reference taught point 106 is completed in this manner, the CPU 33 reads the parameters of the selected taught point "P001" recorded in the storage device 35, and displays the display screen E of the display device C based on the read parameters. Update. Specifically, the display of "reference" in the teaching point list 206 is switched to the display corresponding to the teaching point "P001" as shown in FIG. 5(b).

また、この時、同時に表示装置Cの仮想環境画面10の表示も例えば図4(b)のように更新することができる。図4(b)は、更新後の表示装置Cの仮想環境画面10に表示されているロボット101の位置姿勢を側方から示している。図4(b)の仮想環境画面10では、ロボット101のアームの基準部位が(基準)教示点106と一致する位置姿勢を表示している。 At this time, the display of the virtual environment screen 10 on the display device C can also be updated at the same time, for example, as shown in FIG. 4(b). FIG. 4B shows the position and orientation of the robot 101 displayed on the virtual environment screen 10 of the display device C after updating from the side. The virtual environment screen 10 of FIG. 4B displays a position and orientation in which the reference portion of the arm of the robot 101 coincides with the (reference) teaching point 106 .

本実施例では、新規のオフセット教示点107を入力するために任意の座標系を選択することができる(座標系選択手段、ステップS2)。 In this embodiment, any coordinate system can be selected for inputting the new offset teaching point 107 (coordinate system selection means, step S2).

例えば、ユーザは図5(b)に示すように、座標系選択部204をマウスのカーソル205でクリックする。これに応じて、CPU33は、表示装置Cを制御して、パラメータ設定画面20の座標系選択部204を例えばプルダウンメニューのように用いて選択可能な座標系リスト207を表示させる。ユーザ(作業者)は、この座標系選択部204に表示される座標系リスト207にある座標系を選択することができる。ここで、ユーザは座標系リスト207から、例えばツール座標系105を選択する。 For example, the user clicks the coordinate system selection section 204 with the cursor 205 of the mouse, as shown in FIG. 5(b). In response, the CPU 33 controls the display device C to display a selectable coordinate system list 207 using the coordinate system selection section 204 of the parameter setting screen 20 like a pull-down menu, for example. A user (operator) can select a coordinate system from a coordinate system list 207 displayed in the coordinate system selection section 204 . Here, the user selects, for example, the tool coordinate system 105 from the coordinate system list 207 .

図5(a)~(d)に示すように、パラメータ設定画面20(の左側)には絶対値設定部201、相対値設定部202を表示する。ユーザは、これら絶対値設定部201、相対値設定部202を用い、上記のようにして指定した教示点に関して、指定した座標系における位置姿勢データを数値入力することができる。位置姿勢データとしては、絶対値設定部201、相対値設定部202は、例えば、X、Y、Z、α、β、γで示すように3次元座標値と軸廻りの回転角により指定することができる。このうち、座標値の単位は例えばmm、また、軸廻りの回転角には、例えばオイラー角ZYX(αβγ)表現を用いる。 As shown in FIGS. 5A to 5D, an absolute value setting section 201 and a relative value setting section 202 are displayed on (the left side of) the parameter setting screen 20. FIG. The user can use the absolute value setting unit 201 and the relative value setting unit 202 to numerically input the position and orientation data in the designated coordinate system for the teaching points designated as described above. As the position and orientation data, the absolute value setting unit 201 and the relative value setting unit 202 specify, for example, three-dimensional coordinate values and rotation angles around axes as indicated by X, Y, Z, α, β, and γ. can be done. Among them, the unit of coordinate values is, for example, mm, and the rotation angle around the axis is expressed by, for example, Euler angles ZYX (αβγ).

この段階で、ユーザは新規のオフセット教示点107のオフセットとなる相対値を設定することができる(パラメータ設定手段、ステップS3)。 At this stage, the user can set a relative value to be the offset of the new offset teaching point 107 (parameter setting means, step S3).

絶対値設定部201、相対値設定部202の上部は、作成する教示点名を入力・表示する教示点名設定部212となっている。ここで、ユーザは、教示点名設定部212に所望の教示点名(例えば図5の例では「P100」)を入力する。また、この段階で、教示点名設定部212にはCPU33が自動的に生成した教示点名を入力済みの状態で表示するようにしてもよい。 Above the absolute value setting section 201 and the relative value setting section 202 is a teaching point name setting section 212 for inputting and displaying the names of teaching points to be created. Here, the user inputs a desired teaching point name (for example, “P100” in the example of FIG. 5) to the teaching point name setting section 212 . Further, at this stage, the taught point name setting section 212 may display the taught point names automatically generated by the CPU 33 in the input state.

また、新規のオフセット教示点107の入力において、相対値設定部202の全てのフィールドの初期状態は0(図5(b))で、この時、絶対値設定部201には、例えば基準となる教示点106の位置姿勢データと同じ値(コピー)を表示することができる。 In addition, when the new offset teaching point 107 is input, the initial state of all the fields of the relative value setting unit 202 is 0 (FIG. 5(b)). The same value (copy) as the position and orientation data of the teaching point 106 can be displayed.

また、この段階では、前述のようにして図4(b)のようにアームの基準部位が(基準)教示点106と一致した状態となっており、教示点106(P001)に対するオフセットの指定には、例えばツール座標系105を用いることができる。そこで、ここでは、(上記のように指定済みの)ツール座標系105を用いて、Z軸方向に前述の「30mm」のオフセットするオフセット教示点107を指定し、作成する。 Also, at this stage, as described above, the reference portion of the arm coincides with the (reference) teaching point 106 as shown in FIG. can use the tool coordinate system 105, for example. Therefore, here, using the tool coordinate system 105 (designated as described above), the offset teaching point 107 to be offset by "30 mm" in the Z-axis direction is designated and created.

ユーザは、例えば、図5(c)のように操作入力部Dのマウスを用いて相対値設定部202のZ座標値のフィールドに対応する設定欄208を選択し、操作入力部Dのキーボードから「30」の値を入力し、同キーボードの[Enter]キーを押下する。 For example, as shown in FIG. Enter a value of "30" and press the [Enter] key on the same keyboard.

CPU33は、相対値設定部202への数値入力に応じて、記憶装置35の例えばRAMなどに配置された相対値設定部202に対応するメモリ領域の内容を更新する。即ち、操作入力部Dで位置姿勢データの一部を変更する操作入力が行われると、操作入力の内容に応じて当該の一部の位置姿勢データを変更する(第1の演算工程)。 The CPU 33 updates the contents of the memory area corresponding to the relative value setting section 202 arranged in the RAM of the storage device 35 according to the numerical value input to the relative value setting section 202 . That is, when an operation input for changing part of the position and orientation data is performed on the operation input unit D, the part of the position and orientation data is changed according to the content of the operation input (first calculation step).

操作入力部Dのキーボードで[Enter]キーを押下すると、CPU33のソフトウェアにより構成された計算部34の位置姿勢演算が開始される(姿勢計算手段)。 When the [Enter] key is pressed on the keyboard of the operation input section D, the position and orientation calculation of the calculation section 34 configured by the software of the CPU 33 is started (attitude calculation means).

ここでは、まず、オフセット教示点107に関して選択されている座標系がツール座標系105か判断する(図3ステップS4)。ここで選択されている座標系がツール座標系105の場合、ステップS5に進み、ツール座標系105の姿勢計算処理を実行する(関節値計算処理、ステップS5)。 Here, first, it is determined whether the coordinate system selected for the offset teaching point 107 is the tool coordinate system 105 (step S4 in FIG. 3). If the coordinate system selected here is the tool coordinate system 105, the process advances to step S5 to execute posture calculation processing for the tool coordinate system 105 (joint value calculation processing, step S5).

なお、ここで関節値とは、ロボット101のある関節の曲げ(回転)角度などにより表現され、その関節の位置(または姿勢)を特定する関節データである。このような関節データは、本実施例においては、後述の制約エラーのチェックなどのために演算の途中で利用されるが、明示的に位置姿勢データの一部として関節データを直接、入力、編集する例については、後述の実施例5で説明する。 Here, the joint value is represented by a bending (rotating) angle of a certain joint of the robot 101, and is joint data specifying the position (or posture) of the joint. In the present embodiment, such joint data is used in the middle of calculations for purposes such as constraint error checking, which will be described later. An example of doing so will be described in Example 5 below.

ここで、ツール座標系105を選択している場合の計算は、以下の式(1)のように行う(座標変換)。ここでは、基準となる教示点106の相対値の姿勢行列Tと、オフセットとなる相対値の姿勢行列Tの積より、ロボット101のベース座標系104からオフセット教示点107までの相対値の姿勢行列Tを計算する。 Here, the calculation when the tool coordinate system 105 is selected is performed as in the following formula (1) (coordinate transformation). Here, the relative values from the base coordinate system 104 of the robot 101 to the offset teaching point 107 are obtained from the product of the posture matrix T1 of the relative values of the teaching point 106 serving as the reference and the posture matrix T2 of the relative values serving as the offset. Compute the pose matrix T3 .

Figure 0007322099000001
Figure 0007322099000001

ここで姿勢行列Tは、次式(2)の如く4行4列の行列とし、1行・1列から3行・3列までのパラメータを回転行列R、1行から3行までの4列目を位置行列P、4行・1列から4行・3列までを0行列、4行・4列を1としたものである。 Here, the posture matrix T is a matrix of 4 rows and 4 columns as shown in the following equation (2), the parameters from the 1st row and 1st column to the 3rd row and 3rd column are the rotation matrix R, and the 4 columns from the 1st row to the 3rd row are 0 matrix from the 4th row/1st column to the 4th row/3rd column, and 1s at the 4th row/4th column.

Figure 0007322099000002
Figure 0007322099000002

そして、式(1)の計算結果より逆運動学計算を行い、ロボット101の各軸の関節値を計算する。即ち、ステップS5(あるいは後述のS6)において、CPU33は、上記第1の演算工程において変更された一部の(オフセット教示点107の)位置姿勢データに基づき、ロボット装置の各部位の位置または姿勢をそれぞれ特定する位置姿勢演算を行う。この位置姿勢演算の結果に基づき新たな位置姿勢データ(例えば関節値)を求める(第2の演算工程)。 Then, inverse kinematics calculation is performed from the calculation result of equation (1) to calculate the joint values of each axis of the robot 101 . That is, in step S5 (or S6 to be described later), the CPU 33 calculates the position or orientation of each part of the robot apparatus based on the partial position/orientation data (of the offset teaching points 107) changed in the first calculation step. Position and orientation calculations are performed to specify each of the . New position and orientation data (for example, joint values) are obtained based on the result of this position and orientation calculation (second calculation step).

さらに、CPU33は、逆運動学計算結果より表示装置Cの表示画面Eの表示を更新する(図3ステップS7~S9)。即ち、CPU33は、第1の演算工程において変更された一部の位置姿勢データ、および第2の演算工程において計算された新たな位置姿勢データに基づき、表示装置Cの表示画面Eの表示を更新する(表示更新工程)。 Furthermore, the CPU 33 updates the display on the display screen E of the display device C based on the result of the inverse kinematics calculation (steps S7 to S9 in FIG. 3). That is, the CPU 33 updates the display on the display screen E of the display device C based on the partial position/orientation data changed in the first calculation step and the new position/orientation data calculated in the second calculation step. (display update step).

表示装置Cの表示画面Eの表示更新では、例えば、表示装置Cの管理画面40、仮想環境画面10の仮想表示、ないしパラメータ設定画面20の数値表示の内容を更新する。なお、この表示装置Cの表示画面Eの更新に先立ち、第2の演算工程で算出した位置姿勢データに相当する各関節値が実機のロボット101のハードウェア仕様などにより定まる制約内か否かのエラーチェックを行う(下記のステップS7)。 In updating the display of the display screen E of the display device C, for example, the management screen 40 of the display device C, the virtual display of the virtual environment screen 10, or the numerical value display of the parameter setting screen 20 are updated. Prior to updating the display screen E of the display device C, it is determined whether or not each joint value corresponding to the position and orientation data calculated in the second calculation process is within the constraints determined by the hardware specifications of the actual robot 101 or the like. An error check is performed (step S7 below).

ステップS7では、オフセット教示点107の各関節値が実機のロボット101のハードウェアの仕様(あるいはさらに運用上の規約)などにより定まる制約内か判断する(制約判断処理)。例えば、実機のロボット装置では、ある関節が取り得る回転角の範囲が特定の範囲に制約されている場合があり、このような制約の範囲内にロボット101の各関節値が収まっているか否かを判定する。このようなロボット101の可動範囲などの制約の条件は、適当な格納形式で予めROM35a、RAM35bや外部記憶装置35cなどに格納されているものとする。 In step S7, it is determined whether each joint value of the offset teaching point 107 is within the constraints determined by the hardware specifications (or operational rules) of the actual robot 101 (constraint determination processing). For example, in an actual robot device, the range of possible rotation angles of a certain joint may be restricted to a specific range. judge. It is assumed that such restrictive conditions such as the movable range of the robot 101 are stored in advance in the ROM 35a, the RAM 35b, the external storage device 35c, or the like in an appropriate storage format.

ステップS7の判定の結果が制約内であれば、CPU33は表示装置Cの表示画面Eを更新する(正常系表示処理、S9)。ここでは、仮想環境画面10のロボット101の表示と、パラメータ設定画面20の内容を更新する。ここで、ロボット101のベース座標系104は、前述のように絶対座標系100と一致している。そのため、更新内容は、ベース座標系104からのオフセット教示点107までの相対値を絶対値設定部201に、逆運動学計算によるロボット101の各軸の関節値の計算結果を仮想環境画面10に反映させて更新する。 If the result of determination in step S7 is within the constraints, the CPU 33 updates the display screen E of the display device C (normal system display processing, S9). Here, the display of the robot 101 on the virtual environment screen 10 and the contents of the parameter setting screen 20 are updated. Here, the base coordinate system 104 of the robot 101 matches the absolute coordinate system 100 as described above. Therefore, the contents of the update are the relative values from the base coordinate system 104 to the offset teaching point 107 to the absolute value setting unit 201, and the calculation results of the joint values of each axis of the robot 101 by inverse kinematics calculation to the virtual environment screen 10. Update to reflect.

さらに、この表示装置Cの表示画面Eの更新では、変更箇所、非変更箇所を含め、GUI全体(仮想環境画面10、パラメータ設定画面20あるいはさらに管理画面40)を更新する。その結果、例えばパラメータ設定画面20は図4(c)のように更新される。 Furthermore, in updating the display screen E of the display device C, the entire GUI (virtual environment screen 10, parameter setting screen 20, or management screen 40) including changed parts and unchanged parts is updated. As a result, for example, the parameter setting screen 20 is updated as shown in FIG. 4(c).

図4(c)は、更新後の表示装置Cの仮想環境画面10のロボット101の表示を示している。図4(b)と比較して明らかなように、図4(c)ではロボット101の表示はアームの基準部位がオフセット教示点107に位置する位置姿勢に変更されている。図4(c)において、d30として示されているのは、上記の30mmのオフセット量である。 FIG. 4C shows the display of the robot 101 on the virtual environment screen 10 of the display device C after updating. As is clear from comparison with FIG. 4B, in FIG. 4C, the display of the robot 101 is changed to a position and orientation in which the reference portion of the arm is positioned at the offset teaching point 107. FIG. In FIG. 4(c), what is shown as d30 is the offset amount of 30 mm.

また、図5(d)は、更新後の表示装置Cの表示画面Eのパラメータ設定画面20の表示を示している。ステップS7でエラーが起きていなければ、同図のようにオフセット教示点107のパラメータが更新される。 FIG. 5D shows the display of the parameter setting screen 20 of the display screen E of the display device C after updating. If no error has occurred in step S7, the parameters of the offset teaching point 107 are updated as shown in FIG.

以上のように、操作入力部Dを用いて相対値設定部202に入力を行うと、直ちに仮想環境画面10のロボット101の表示と、パラメータ設定画面20の表示が更新され、新規のオフセット教示点107における位置姿勢とパラメータを確認できる。 As described above, when an input is made to the relative value setting unit 202 using the operation input unit D, the display of the robot 101 on the virtual environment screen 10 and the display on the parameter setting screen 20 are immediately updated, and a new offset teaching point is added. The pose and parameters at 107 can be confirmed.

従って、ユーザ(作業者)は実際にロボット装置が情報処理装置Aに接続されていなくても、あるいはその実機のロボット装置を動作させなくても、表示装置Cの表示画面Eを視認するだけで入力(編集)操作の妥当性を確認することができる。これにより、従来必要であった入力(編集)操作の妥当性の確認に必要な工数の削減を図ることが出来る。 Therefore, even if the robot device is not actually connected to the information processing device A, or the actual robot device is not operated, the user (operator) can simply view the display screen E of the display device C. Validity of input (edit) operation can be checked. As a result, it is possible to reduce the number of man-hours required for confirming the validity of input (editing) operations, which was conventionally required.

一方、ステップS7において、位置姿勢演算の結果、例えば各関節値のいずれかがハードウェア的な制約を外れている場合、CPU33は表示装置Cで姿勢が取れないというエラーを表示させる(異常表示処理、S8)。例えばこの時、表示させるエラー画面50は、図8のようなものが考えられる。図8のエラー画面50は、到達姿勢がリミットの制約外にあり、エラーが発生していることを文字列および図形のシンボルによって表示している。 On the other hand, in step S7, as a result of the position/orientation calculation, for example, if any of the joint values is out of hardware constraints, the CPU 33 causes the display device C to display an error indicating that the orientation cannot be taken (abnormal display processing). , S8). For example, the error screen 50 to be displayed at this time may be as shown in FIG. The error screen 50 in FIG. 8 indicates that the arrival attitude is outside the limits and that an error has occurred using a character string and graphic symbols.

この画面を表示する場合は、CPU33はパラメータ設定画面20のオフセット教示点107の数値をクリアし、相対値入力前(例えば図5(a)または(b))の状態に戻す。その後、図3の制御の場合はステップS3の相対値の編集(入力)操作に戻るため、上記同様にしてオフセット教示点107の入力値を変更するなどの作業を行うことができる。 When displaying this screen, the CPU 33 clears the numerical value of the offset teaching point 107 on the parameter setting screen 20 and restores the state before inputting the relative value (for example, FIG. 5(a) or (b)). After that, in the case of the control of FIG. 3, the process returns to the editing (input) operation of the relative value in step S3, so work such as changing the input value of the offset teaching point 107 can be performed in the same manner as described above.

即ち、CPU33は、前記第2の演算工程における計算の結果、得られた位置姿勢データがロボット101の機構の制約の範囲内にあるか否かを判定する。もし、当該の位置姿勢データが前記ロボット装置の機構の制約の範囲内を超える場合、編集エラーを報知するエラー情報(例えばエラー画面50)を生成する。 That is, the CPU 33 determines whether or not the position/orientation data obtained as a result of the calculation in the second calculation step is within the limits of the mechanical constraints of the robot 101 . If the relevant position/orientation data exceeds the limits of the mechanism of the robot device, error information (for example, an error screen 50) is generated to report an editing error.

続いて、仮想環境画面10のロボット101の表示と、パラメータ設定画面20の表示を視認したユーザは目的の到達姿勢かどうかを確認する操作を行う(ステップS10)。ステップS10において、オフセット教示点107が目的の到達姿勢の場合、マウスのカーソルで確定ボタン209を選択し、クリックする確認操作を行う。この確認操作によってオフセット教示点107の作成が完了する。これにより、CPU33は、確定されたオフセット教示点107の情報を記憶装置35に格納する。 Subsequently, the user who visually recognizes the display of the robot 101 on the virtual environment screen 10 and the display of the parameter setting screen 20 performs an operation to confirm whether or not the desired reaching posture is achieved (step S10). In step S10, when the offset teaching point 107 is in the desired reaching posture, the OK button 209 is selected with the mouse cursor and a confirmation operation is performed by clicking. This confirmation operation completes the creation of the offset teaching point 107 . As a result, the CPU 33 stores information on the determined offset teaching point 107 in the storage device 35 .

以上のようにして、新規のオフセット教示点107の作成が終了する(記録手段、図3のステップS11)。なお、記憶装置35に記録する情報としては、例えば、基準となる教示点106の情報、選択した座標系の情報、オフセット情報の3つの情報をオフセット教示点107の(に関する)情報とし、この情報を記憶装置35に記録する。あるいはさらに、この教示点の情報が相対的な「オフセット」情報であることを示すデータクラスなどに係るタグ情報を含めて記憶装置35に格納してもよい。このような格納形式によれば、オフセット教示点107が教示点106を基準として定義されている、即ち、教示点107が教示点106の下位に従属するデータであることを特定できる。 Thus, the creation of the new offset teaching point 107 is completed (recording means, step S11 in FIG. 3). As information to be recorded in the storage device 35, for example, information on the teaching point 106 serving as a reference, information on the selected coordinate system, and offset information are set as information (relating to) the offset teaching point 107, and this information is recorded in the storage device 35 . Alternatively, this teaching point information may be stored in the storage device 35 including tag information relating to a data class indicating that it is relative "offset" information. According to such a storage format, it is possible to specify that the offset teaching point 107 is defined with reference to the teaching point 106 , that is, that the teaching point 107 is data subordinate to the teaching point 106 .

なお、新規のオフセット教示点107の作成に関しては、CPU33の制御によって管理画面40の表示も更新することができる。ここで、図7(a)、(b)は、それぞれオフセット教示点107の作成前、およびオフセット教示点107の作成完了後の管理画面40の表示状態を示している。図7(a)ではロボット101のツリーには、P001、P010、P020の各々の教示点106のノード、TCP(105)およびTool(102)のノードが階層化されている。 Regarding the creation of the new offset teaching point 107 , the display of the management screen 40 can also be updated under the control of the CPU 33 . Here, FIGS. 7A and 7B show the display state of the management screen 40 before creation of the offset teaching point 107 and after completion of creation of the offset teaching point 107, respectively. In FIG. 7A, the tree of the robot 101 is hierarchized with the nodes of the teaching points 106 of P001, P010, and P020, and the nodes of TCP (105) and Tool (102).

そして、上記のようにして新規のオフセット教示点107を正常に作成すると、ノードの管理画面40の基準となる教示点106の下位に新規のオフセット教示点107のノードが新たに作成されている。このように基準となる教示点106の下位に新規のオフセット教示点107のノードを表示する。これにより、ユーザはオフセット教示点107が親である教示点106のノードに子として従属する関係を有する(オフセット)教示点であることを極めて明確に認識することができる。 Then, when the new offset teaching point 107 is normally created as described above, a node of the new offset teaching point 107 is newly created below the taught point 106 serving as the reference on the node management screen 40 . In this way, the node of the new offset teaching point 107 is displayed below the teaching point 106 serving as the reference. As a result, the user can very clearly recognize that the offset taught point 107 is a (offset) taught point having a subordinate relation as a child to the node of the parent taught point 106 .

なお、図7の管理画面40の各ノードは、当該のノードを選択するGUI上のボタン(やアイコン)として用いることができる。例えば、管理画面40の各ノードをマウスなどを用いてクリックした場合、CPU33は、そのノードの(位置姿勢)データの編集操作が指定されたものと判定する。例えば、オフセット教示点107の編集を行う場合には、管理画面40のオフセット教示点107をマウスのカーソルでクリックすることにより、ユーザは同教示点の(再)編集を開始することができる。 Note that each node on the management screen 40 of FIG. 7 can be used as a button (or icon) on the GUI for selecting the node in question. For example, when each node on the management screen 40 is clicked using a mouse or the like, the CPU 33 determines that an edit operation of the (position and orientation) data of that node has been designated. For example, when editing the offset teaching point 107, the user can start (re)editing the same teaching point by clicking the offset teaching point 107 on the management screen 40 with the mouse cursor.

なお、記憶装置35に格納した位置姿勢データは、ツリーの全体(例えば図7のツリーの全体)、または操作入力部Dで指定した特定の一部などを単位としてファイルFの形式でインターフェース36を介して外部装置に出力することができる(入出力手段)。 The position/orientation data stored in the storage device 35 is stored in the interface 36 in the form of a file F in units of the entire tree (for example, the entire tree in FIG. 7) or a specific portion designated by the operation input unit D. can be output to an external device via (input/output means).

このようにして出力したファイルFは、後日、インターフェース36で読み込むことができる。これにより、ファイルFから例えばツリーの全体(例えば図7のツリーの全体)を読み込んだ場合には、ファイルFの位置姿勢データを作成した時のシステムの状態を復旧することができる。例えば、ファイルFの読み込みに応じて、CPU33は図7(b)の管理画面40を表示し、例えばそこからオフセット教示点107を選択すると、図4(c)、図5(d)の状態を再現できる。 The file F output in this manner can be read by the interface 36 at a later date. As a result, when the entire tree (for example, the entire tree in FIG. 7) is read from file F, the state of the system when the position and orientation data of file F was created can be restored. For example, when the file F is read, the CPU 33 displays the management screen 40 shown in FIG. 7(b), and selects the offset teaching point 107 therefrom, thereby changing the states shown in FIGS. 4(c) and 5(d). Reproducible.

また、ファイルFを、実機のロボット装置のコントローラと共有フォーマットに整え(変換し)てインターフェース36から出力することもできる。これにより、情報処理装置Aで作成した教示データを直接、実機のロボット装置に入力することができる。 Also, the file F can be prepared (converted) into a format shared by the controller of the actual robot device and output from the interface 36 . As a result, the teaching data created by the information processing apparatus A can be directly input to the actual robot apparatus.

ここで、例えば、実機のロボット装置のコントローラのインターフェースが動作プログラムとオフセット変数で構成されている場合がある。このような場合には、CPU33は、ファイルFを介して、基準となる教示点106の情報は教示点情報として出力させ、オフセット教示点107の情報は動作プログラムのオフセット編集情報として出力させるような形態が考えられる。 Here, for example, the interface of the controller of the actual robot device may consist of an operation program and an offset variable. In such a case, the CPU 33 outputs the information of the reference taught point 106 as taught point information and the information of the offset taught point 107 as offset editing information of the operation program. form is conceivable.

また、実機のロボット装置のコントローラの教示点情報のインターフェースがロボットのベース座標系104からの相対値情報のみを用いる構成も考えられる。このような場合には、CPU33がオフセット教示点107と基準となる教示点106の積を計算し、全ての教示点情報をロボットのベース座標系104からの相対値に変換してからファイルFを介して出力することができる。 Also, a configuration is conceivable in which the interface of the teaching point information of the controller of the actual robot apparatus uses only the relative value information from the base coordinate system 104 of the robot. In such a case, the CPU 33 calculates the product of the offset teaching point 107 and the reference teaching point 106, converts all the teaching point information into relative values from the robot base coordinate system 104, and then saves the file F. can be output via

以上のように、インターフェース36およびファイルFを介して行う外部機器、特に実機のロボット装置とのデータの入出力の際、必要なフォーマット変換を行うことにより、様々な実機のロボット装置(あるいはコントローラ)に対応することができる。 As described above, when inputting/outputting data to/from an external device, especially an actual robot device, through the interface 36 and the file F, various actual robot devices (or controllers) can be used by performing necessary format conversions. can correspond to

なお、オフセット教示点107の作成を止める場合は、図5(a)~(d)のパラメータ設定画面20右上部のキャンセルボタン210をマウスのカーソルなどによってクリックする。このキャンセルボタン210をクリックすると、CPU33はオフセット教示点107に関する情報を削除し、オフセット教示点107作成前の状態に表示装置Cの表示画面Eを更新する。 To stop creating the offset teaching point 107, click the cancel button 210 on the upper right portion of the parameter setting screen 20 in FIGS. When the cancel button 210 is clicked, the CPU 33 deletes the information about the offset taught point 107 and updates the display screen E of the display device C to the state before the offset taught point 107 was created.

以上のようにして、新規のオフセット教示点107を作成することができる。 As described above, a new offset teaching point 107 can be created.

(ベース座標系を用いたオフセット教示点の作成)
次に、2つ目のケース、基準となる教示点106よりベース座標系104を選択し、Z軸方向に「-30mm」オフセットを行うオフセット教示点107の作成手順と処理について図6(a)~(d)を用いて説明する。図6(a)~(d)は、図5(a)~(d)と同等の様式でパラメータ設定画面20のGUIの遷移を示している。なお、ベース座標系104を用いる場合の制御手順については、前述の図3の一部に記述されている。
(Creation of offset teaching points using base coordinate system)
Next, in the second case, the base coordinate system 104 is selected from the reference teaching point 106, and the creation procedure and processing of the offset teaching point 107 that offsets "-30 mm" in the Z-axis direction is shown in FIG. 6(a). This will be described using (d). FIGS. 6(a) to (d) show transition of the GUI of the parameter setting screen 20 in the same manner as FIGS. 5(a) to (d). Note that the control procedure when using the base coordinate system 104 is described in part of FIG. 3 above.

図6(a)は、基準となる教示点106の設定操作で、基準となる教示点106を前述の図5(a)と同様に教示点設定部203を例えばプルダウンメニューのように用いて選択する(教示点設定手段、図3のステップS1)。 FIG. 6A shows an operation for setting the reference taught point 106. The reference taught point 106 is selected by using the taught point setting unit 203, for example, as a pull-down menu in the same manner as in FIG. 5A. (teaching point setting means, step S1 in FIG. 3).

次に、ベース座標系104を選択する(座標系選択手段、ステップS2)。図6(b)は、座標系の選択操作を示しており、ここでは前述の図5(b)と同様に座標系選択部204を例えばプルダウンメニューのように用いてベース座標系104を選択する(座標系選択手段、ステップS2)。 Next, the base coordinate system 104 is selected (coordinate system selection means, step S2). FIG. 6(b) shows a selection operation of the coordinate system. Here, the base coordinate system 104 is selected by using the coordinate system selection section 204 like a pull-down menu, similar to FIG. 5(b) described above. (Coordinate system selection means, step S2).

このようにして、基準となる教示点106の選択と、入力に用いる座標系(ベース座標系104)の選択が終了し、オフセット教示点107のオフセットとなる相対値設定に必要な準備が完了する。 In this way, the selection of the reference teaching point 106 and the selection of the coordinate system (base coordinate system 104) used for input are completed, and preparations necessary for setting the offset relative value of the offset teaching point 107 are completed. .

次に、オフセットとなる相対値を設定する(パラメータ設定手段、S3)。図6(c)は、相対値設定部202の設定欄208へ設定する状況を示している。ここでは、相対値設定部202のZ軸の設定欄208をマウスのカーソルでクリックする。相対値設定部202のZ軸の設定欄208に操作入力部Dで操作しているキーボードで「-30」という数値を入力し、[Enter]キーを押下する。 Next, a relative value to be an offset is set (parameter setting means, S3). FIG. 6(c) shows the setting in the setting column 208 of the relative value setting unit 202. As shown in FIG. Here, the Z-axis setting field 208 of the relative value setting section 202 is clicked with the mouse cursor. A numerical value of "-30" is input in the Z-axis setting field 208 of the relative value setting unit 202 using the keyboard operated by the operation input unit D, and the [Enter] key is pressed.

なお、このオフセット入力値は、上述のツール座標系を用いた下方30mmのオフセット入力の例と等価である。オフセット「30」の符号が異なっているのは、入力に用いる座標系が前述の例ではツール座標系が用いられ、この例ではベース座標系が用いられていることによる。即ち、前述の例で30(mm)とプラスの値を入力しているのは、前述のツール座標系では、通常、ツール前方がZ軸の正方向に取られているためである。また、この例で-30(mm)とマイナスの値を入力しているのは、ベース座標系では、(図4の上方)Z軸の正方向であるため、下方へのオフセットが負値となるためである。 This offset input value is equivalent to the example of the offset input of 30 mm below using the tool coordinate system described above. The difference in the sign of the offset "30" is because the coordinate system used for input is the tool coordinate system in the above example and the base coordinate system in this example. That is, the reason why a positive value such as 30 (mm) is input in the above example is that in the above tool coordinate system, the front of the tool is normally taken in the positive direction of the Z axis. Also, in this example, -30 (mm) and a negative value are entered because in the base coordinate system, the positive direction of the Z-axis (upper in FIG. 4) means that the downward offset is a negative value. It is for the sake of becoming.

CPU33は、相対値設定部202への数値入力に応じて、記憶装置35の例えばRAMなどに配置された相対値設定部202に対応するメモリ領域の内容を更新する。即ち、操作入力部Dで位置姿勢データの一部を変更する操作入力が行われると、操作入力の内容に応じて当該の一部の位置姿勢データを変更する(第1の演算工程)。 The CPU 33 updates the contents of the memory area corresponding to the relative value setting section 202 arranged in the RAM of the storage device 35 according to the numerical value input to the relative value setting section 202 . That is, when an operation input for changing part of the position and orientation data is performed on the operation input unit D, the part of the position and orientation data is changed according to the content of the operation input (first calculation step).

続いて、ユーザが操作入力部Dのキーボードで[Enter]キーを押下すると、CPU33は計算部34の機能によって位置姿勢演算を実行する(姿勢計算手段)。 Subsequently, when the user presses the [Enter] key on the keyboard of the operation input unit D, the CPU 33 executes the position/orientation calculation by the function of the calculation unit 34 (attitude calculation means).

ここでは、まず、選択された座標系がツール座標系105か判断する(図3のステップS4)。この例では、選択されているのはベース座標系104であるからステップS4からS6に進み、ベース座標系104の位置姿勢演算を行う(ステップS6)。 Here, first, it is determined whether the selected coordinate system is the tool coordinate system 105 (step S4 in FIG. 3). In this example, the base coordinate system 104 is selected, so the process proceeds from step S4 to step S6, and the position and orientation of the base coordinate system 104 are calculated (step S6).

例えば、ベース座標系104の位置姿勢演算の場合、姿勢行列を位置行列と回転行列に分けて計算を行い、最後に計算結果の積を求める手順で計算を行う。 For example, in the case of calculating the position and orientation of the base coordinate system 104, calculation is performed by dividing the orientation matrix into a position matrix and a rotation matrix, and finally calculating the product of the calculation results.

まず、ロボット101のベース座標系104から基準となる教示点106までの相対値の姿勢行列Tと、オフセット教示点107のオフセットとなる相対値の姿勢行列Tの位置行列の和を計算し、姿勢行列Ttmp1を作成する(下記の式(3))。なお、この時の回転行列Rtmp1を0とする。 First, the sum of the posture matrix T1 of the relative values from the base coordinate system 104 of the robot 101 to the teaching point 106 serving as the reference and the position matrix of the posture matrix T2 of the relative values serving as the offset of the offset teaching point 107 is calculated. , pose matrix T tmp1 (equation (3) below). Note that the rotation matrix R_tmp1 at this time is set to 0.

Figure 0007322099000003
Figure 0007322099000003

次に、オフセット教示点107のオフセットとなる相対値の姿勢行列Tより、位置行列P2を0とした姿勢行列Ttmp2を作成する(下記の式(4))。 Next, an attitude matrix T_tmp2 with the position matrix P2 set to 0 is created from the attitude matrix T_2 of the relative values that are the offsets of the offset teaching point 107 (equation (4) below).

Figure 0007322099000004
Figure 0007322099000004

次に、ロボット101のベース座標系104から基準となる教示点106までの相対値の姿勢行列Tより、位置行列P1を0とした姿勢行列Ttmp3を作成する(下記の式(5))。 Next, from the attitude matrix T1 of the relative values from the base coordinate system 104 of the robot 101 to the reference teaching point 106, an attitude matrix Ttmp3 with the position matrix P1 set to 0 is created (equation (5) below). .

Figure 0007322099000005
Figure 0007322099000005

次に、式(3)、(4)、(5)の積より、ロボット101のベース座標系104からオフセット教示点107までの相対値の姿勢行列Tを計算する(下記の式(6))。 Next, from the product of equations (3), (4), and (5), a posture matrix T3 of relative values from the base coordinate system 104 of the robot 101 to the offset teaching point 107 is calculated (equation (6) below ).

Figure 0007322099000006
Figure 0007322099000006

さらに式(6)の計算結果より逆運動学計算を行い、ロボット101の各軸の関節値を計算する。即ち、ステップS6において、CPU33は、上記第1の演算工程において変更された一部の(オフセット教示点107の)位置姿勢データに基づき、ロボット装置の各部位の位置または姿勢をそれぞれ特定する位置姿勢演算を行う。この位置姿勢演算の結果に基づき新たな位置姿勢データ(例えば関節値)を求める(第2の演算工程)。 Further, inverse kinematics calculation is performed from the calculation result of equation (6) to calculate the joint values of each axis of the robot 101 . That is, in step S6, the CPU 33 determines the position and orientation of each part of the robot device based on the partial position and orientation data (of the offset teaching points 107) changed in the first calculation step. perform calculations. New position and orientation data (for example, joint values) are obtained based on the result of this position and orientation calculation (second calculation step).

以上の位置姿勢演算によって、ベース座標系104を選択した場合のオフセット教示点107を求めることができる。 With the position and orientation calculations described above, the offset teaching point 107 when the base coordinate system 104 is selected can be obtained.

図3の制御において、続くステップS7からS11の制約範囲内か否かの判定は、前述のツール座標系105を用いたオフセット教示点107の入力の場合と同様に実行される。制約範囲内か否かの判定に関するエラー処理(例えば図8のメッセージ表示:ステップS8)は前述と同様に実施することができる。 In the control of FIG. 3, determination of whether or not it is within the restricted range in subsequent steps S7 to S11 is performed in the same manner as in the case of inputting the offset teaching point 107 using the tool coordinate system 105 described above. Error processing (for example, message display in FIG. 8: step S8) regarding determination of whether or not it is within the restricted range can be performed in the same manner as described above.

上記のベース座標系における位置姿勢演算(ステップS6)の後、エラーが発生していなければ、図3のステップS9において、表示装置Cの仮想環境画面10、パラメータ設定画面20あるいはさらに管理画面40の表示を更新する。この時の様子は、前述のツール座標系を用いる場合に説明した図4(b)~(c)、図5(c)、あるいは図7(a)、(b)などと同様である。また、ステップS10のユーザによる確認と、S11の確定操作も前述のツール座標系を用いる場合と同様である(図5(d))。 After calculating the position and orientation in the base coordinate system (step S6), if no error has occurred, in step S9 of FIG. Refresh the display. The situation at this time is the same as that shown in FIGS. 4(b) to 4(c), 5(c), 7(a) and 7(b), etc., when the tool coordinate system is used. Further, the confirmation by the user in step S10 and the confirmation operation in S11 are the same as in the case of using the tool coordinate system described above (FIG. 5(d)).

即ち、CPU33は、第1の演算工程において変更された一部の位置姿勢データ、および第2の演算工程において計算された新たな位置姿勢データに基づき、表示装置Cの表示画面Eの表示を更新する(表示更新工程)。 That is, the CPU 33 updates the display on the display screen E of the display device C based on the partial position/orientation data changed in the first calculation step and the new position/orientation data calculated in the second calculation step. (display update step).

以上のようにして、ベース座標系104を選択して、オフセット教示点107を作成することができる。そして、オフセット教示点107を作成すると同時に、表示装置Cの仮想環境画面10、パラメータ設定画面20あるいはさらに管理画面40の表示が更新されるため、新規のオフセット教示点107における位置姿勢とパラメータを確認できる。 As described above, the offset teaching point 107 can be created by selecting the base coordinate system 104 . At the same time when the offset teaching point 107 is created, the display of the virtual environment screen 10, the parameter setting screen 20, or the management screen 40 of the display device C is updated. can.

従って、ユーザ(作業者)は実際にロボット装置が情報処理装置Aに接続されていなくても、あるいはその実機のロボット装置を動作させなくても、表示装置Cの表示画面Eを視認するだけで入力(編集)操作の妥当性を確認することができる。これにより、従来必要であった入力(編集)操作の妥当性の確認に必要な工数の削減を図ることが出来る。 Therefore, even if the robot device is not actually connected to the information processing device A, or the actual robot device is not operated, the user (operator) can simply view the display screen E of the display device C. Validity of input (edit) operation can be checked. As a result, it is possible to reduce the number of man-hours required for confirming the validity of input (editing) operations, which was conventionally required.

(オフセット教示点107の編集と座標系の切り替え)
次に、3つ目のケース、作成したオフセット教示点107を編集して座標系の切り替えた場合の制御につき図9を用いて説明する。図9は、入力済みのオフセット教示点107の座標系を切り替えた場合の制御手順を示している。
(Editing the offset teaching point 107 and switching the coordinate system)
Next, the third case, control when the created offset teaching point 107 is edited and the coordinate system is switched, will be described with reference to FIG. FIG. 9 shows a control procedure when the coordinate system of the offset teaching point 107 that has already been input is switched.

従来では、座標系を切り替える必要が生じた場合、作業者(ユーザ)が行列計算を行い、パラメータを計算していたが、計算した数値の入力ミスなど、人為的なミスが発生することがあった。そこで、本例に示すように、座標系を切り替えた際に自動的に切り替えた座標系方向の相対値パラメータを計算する構成によれば、このような人為的な計算ミスを低減させることができる。以下、ベース座標系104とツール座標系105をそれぞれ切り替えた場合につき説明する。ここでは、まずツール座標系105をベース座標系104に切り替えた場合の処理を考える。 In the past, when it was necessary to switch the coordinate system, the operator (user) performed matrix calculations and calculated the parameters. rice field. Therefore, as shown in this example, according to the configuration for automatically calculating the relative value parameter in the direction of the coordinate system that is switched when the coordinate system is switched, such human calculation errors can be reduced. . A case where the base coordinate system 104 and the tool coordinate system 105 are respectively switched will be described below. Here, first consider the processing when the tool coordinate system 105 is switched to the base coordinate system 104 .

オフセット教示点107の編集開始(図9ステップS12)は、例えば、管理画面40(図7(b))において、操作入力部Dのマウスで上述のようにして入力済みのオフセット教示点107(P100)を選択することにより指定する。 The start of editing the offset teaching point 107 (step S12 in FIG. 9) is, for example, the offset teaching point 107 (P100 ).

次に、ツール座標系105をベース座標系104に切り替える(座標系選択手段、ステップS13)。例えば、図5(b)(図6(b))のパラメータ設定画面20の座標系選択部204を操作入力部Dのマウスを用いてクリックすると座標系リスト207が表示される。ここでは、この座標系リスト207を用いてツール座標系105をベース座標系104に切り替える。 Next, the tool coordinate system 105 is switched to the base coordinate system 104 (coordinate system selection means, step S13). For example, when the coordinate system selection section 204 of the parameter setting screen 20 of FIG. 5B (FIG. 6B) is clicked using the mouse of the operation input section D, a coordinate system list 207 is displayed. Here, this coordinate system list 207 is used to switch the tool coordinate system 105 to the base coordinate system 104 .

パラメータ設定画面20の座標系選択部204によってベース座標系104に切り替える(図9のステップS13)と、以下のようにCPU33の計算部34の機能により座標系変換を伴なう位置姿勢演算を行う(姿勢計算手段:本例の場合にはS15)。 When the coordinate system selection unit 204 of the parameter setting screen 20 switches to the base coordinate system 104 (step S13 in FIG. 9), the function of the calculation unit 34 of the CPU 33 performs position and orientation calculations accompanied by coordinate system conversion as follows. (Posture calculation means: S15 in this example).

まず、選択された座標系がツール座標系105か判断し(ステップS4)、ここでベース座標系104が選択された場合、ステップS4からS15に進み、ベース座標系104の相対値計算を実行する(相対値計算処理、ステップS15)。 First, it is determined whether the selected coordinate system is the tool coordinate system 105 (step S4), and if the base coordinate system 104 is selected here, the process proceeds from step S4 to S15, and the relative value calculation of the base coordinate system 104 is executed. (Relative value calculation process, step S15).

ベース座標系104の相対値計算においては、まず式(1)より、ベース座標系104からオフセット教示点107までの相対値の姿勢行列Tを計算する。次に、式(5)より、ベース座標系104から基準となる教示点106までの相対値の姿勢行列Tの位置行列P1を0とした姿勢行列Ttmp3を計算する。 In the calculation of the relative values of the base coordinate system 104, first, the orientation matrix T3 of the relative values from the base coordinate system 104 to the offset teaching point 107 is calculated from equation (1). Next, from equation (5), an attitude matrix Ttmp3 is calculated by setting the position matrix P1 of the attitude matrix T1 of the relative values from the base coordinate system 104 to the reference taught point 106 to 0.

続いて、式(1)と、式(5)の逆行列の積を計算し、姿勢行列Ttmp4を計算する(下記の式(7))。 Subsequently, the product of the formula (1) and the inverse matrix of the formula (5) is calculated to calculate the attitude matrix T tmp4 (the following formula (7)).

Figure 0007322099000007
Figure 0007322099000007

続いて、式(7)で計算した姿勢行列Ttmp4の位置行列Ptmp4を0とした姿勢行列Ttmp5を計算する(下記の式(8))。 Subsequently, the posture matrix T tmp5 is calculated by setting the position matrix P tmp4 of the posture matrix T tmp4 calculated by the formula (7) to 0 (formula (8) below).

Figure 0007322099000008
Figure 0007322099000008

続いて、式(7)で計算した姿勢行列Ttmp4と、式(8)で計算した姿勢行列Ttmp5の逆行列の積を計算し、姿勢行列Ttmp6を計算する(下記の式(9))。 Subsequently, the product of the inverse matrix of the attitude matrix T tmp4 calculated by equation (7) and the inverse matrix of the attitude matrix T tmp5 calculated by equation (8) is calculated to calculate the attitude matrix T tmp6 (equation (9) below ).

Figure 0007322099000009
Figure 0007322099000009

続いて、式(7)の回転行列Rtmp4より、ベース座標系104方向のオフセットとなる相対値の回転成分(α、β、γ)を計算する。そして、式(9)の並進成分Ptmp6からロボット101のベース座標系104から基準となる教示点106までの相対値の姿勢行列Tの位置行列P1の差を計算し、ベース座標系104方向のオフセットとなる相対値の並進成分(X、Y、Z)を計算する。 Subsequently, relative value rotation components (α, β, γ) that are offset in the direction of the base coordinate system 104 are calculated from the rotation matrix R_tmp4 of Equation (7). Then, from the translation component P tmp6 of equation (9), the difference between the position matrix P1 of the attitude matrix T1 of the relative values from the base coordinate system 104 of the robot 101 to the teaching point 106 serving as the reference is calculated. Calculate the translational components (X, Y, Z) of the relative values that are the offsets of .

上記計算結果により出力された、ベース座標系104方向のオフセットとなる相対値(X、Y、Z、α、β、γ)に基づき、CPU33は表示装置Cの表示画面Eを更新する(表示手段)。この場合のように、座標系(のみ)を変更した場合、ロボット101の位置姿勢は変化しないため、表示画面Eの更新は、相対値設定部202についてのみ行えばよい(正常系表示処理、ステップS9)。 The CPU 33 updates the display screen E of the display device C based on the relative values (X, Y, Z, α, β, γ) that are the offsets in the direction of the base coordinate system 104 output as a result of the above calculation (display means ). As in this case, when the coordinate system (only) is changed, the position and orientation of the robot 101 do not change. S9).

座標系(のみ)の変更では、当然ながら仮想環境画面10におけるロボット101の位置姿勢の表示は変化させる必要がない。 When changing (only) the coordinate system, it is of course not necessary to change the display of the position and orientation of the robot 101 on the virtual environment screen 10 .

なお、ここで例えば図4(c)のオフセット教示点107の教示後に表示されるロボット101の位置姿勢では、ツール座標系105とベース座標系104がちょうど一直線上に正負逆方向のZ軸を持った座標系となる姿勢となっている。 Here, for example, in the position and orientation of the robot 101 displayed after teaching the offset teaching point 107 in FIG. It is a posture that becomes a coordinate system.

そのため、パラメータ設定画面20の相対値設定部202の表示は座標系をツール座標系からベース座標系に切り替える前では、図5(d)の表示であったものが、本例の座標系の切り替えによって図6(d)の表示に切り替えられる。即ち、図5(d)で示したツール座標系105でZ軸「30mm」のオフセット量が、座標系切り替えによる座標系計算の結果、図6(d)で示したベース座標系104でZ軸「-30mm」のオフセット量となる。 Therefore, before the coordinate system is switched from the tool coordinate system to the base coordinate system, the display of the relative value setting section 202 of the parameter setting screen 20 is changed from the display shown in FIG. is switched to the display of FIG. 6(d). That is, the offset amount of Z-axis "30 mm" in the tool coordinate system 105 shown in FIG. The offset amount is "-30 mm".

ユーザが上記のように切り替えられた表示装置Cの表示画面Eを視認して確認すると、ステップS16でオフセット教示点107の編集を終了する。 When the user visually confirms the display screen E of the display device C switched as described above, editing of the offset teaching point 107 ends in step S16.

以上のように、本例によれば、ユーザ(作業者)は座標系を切り替えたと同時に、自動的に切り替えた座標系方向の相対値パラメータを確認することができる。従って、従来のように座標系変換に伴なう行列計算を人力で行う必要がなくなり、工数の削減と人為的なミスの低減を図ることができる。 As described above, according to this example, the user (operator) can confirm the relative value parameter of the automatically switched coordinate system direction at the same time when the coordinate system is switched. Therefore, it is no longer necessary to manually perform matrix calculations associated with coordinate system conversion as in the conventional art, and it is possible to reduce man-hours and human errors.

また、ベース座標系104からツール座標系105に切り替える場合の制御は、図9においてステップS4からS14への遷移が生じる(それ以外の制御は上記と同等である)。 Also, the control for switching from the base coordinate system 104 to the tool coordinate system 105 causes a transition from step S4 to step S14 in FIG. 9 (the rest of the control is the same as above).

ベース座標系104からツール座標系105への切り替えにおいても、図9のステップS13で、上述同様にパラメータ設定画面20の座標系選択部204を用いてベース座標系104をツール座標系105に切り替える(座標系選択手段)。 When switching from the base coordinate system 104 to the tool coordinate system 105, the coordinate system selection section 204 of the parameter setting screen 20 is used to switch the base coordinate system 104 to the tool coordinate system 105 in step S13 of FIG. coordinate system selection means).

図9のステップS4では、選択された座標系がツール座標系105か判断し、CPU33の計算部34の機能により座標系変換を伴なう位置姿勢演算(姿勢計算手段:本例の場合にはS14)を行う。 In step S4 of FIG. 9, it is determined whether the selected coordinate system is the tool coordinate system 105, and the function of the calculation unit 34 of the CPU 33 performs position and orientation calculation (posture calculation means: S14) is performed.

このツール座標系105における相対値計算では、オフセット教示点107のオフセットとなる相対値の姿勢行列Tを計算する(下記の式(10))。ここでは、式(6)の計算結果となる姿勢行列Tと、ロボット101のベース座標系104における基準となる教示点106の相対値の姿勢行列Tの逆行列の積として姿勢行列Tを求める。 In this relative value calculation in the tool coordinate system 105, a posture matrix T2 of relative values to be the offset of the offset teaching point 107 is calculated (equation (10) below). Here, the posture matrix T2 is the product of the posture matrix T3 , which is the calculation result of Equation (6), and the inverse matrix of the posture matrix T1 of the relative values of the teaching point 106 serving as the reference in the base coordinate system 104 of the robot 101 . Ask for

Figure 0007322099000010
Figure 0007322099000010

式(10)の計算結果より、オイラー角変換を行い、ツール座標系105方向のオフセット教示点107のオフセットとなる相対値(X、Y、Z、α、β、γ)を計算する。 Euler angle transformation is performed from the calculation result of equation (10), and the relative values (X, Y, Z, α, β, γ) that are the offset of the offset teaching point 107 in the direction of the tool coordinate system 105 are calculated.

上記計算結果により出力された、オフセットとなる相対値(X、Y、Z、α、β、γ)に基づき、CPU33は表示装置Cの表示画面Eを更新(表示手段、ステップS9)し、オフセット教示点107の編集を終了する(ステップS16)。 The CPU 33 updates the display screen E of the display device C (display means, step S9) based on the offset relative values (X, Y, Z, α, β, γ) output from the above calculation results, and offsets Editing of the teaching point 107 is finished (step S16).

当然ながら、この表示更新では、パラメータ設定画面20はベース座標系への変換の場合と逆で、図6(d)の表示から図5(d)の表示に切り替えられる。即ち、座標系切り替えによる座標系計算の結果、図6(d)で示したベース座標系104でZ軸「-30mm」のオフセット量が、図5(d)で示したツール座標系105でZ軸「30mm」のオフセット量となる。座標系(のみ)の変更では、当然ながら仮想環境画面10におけるロボット101の位置姿勢の表示は変化させる必要がない。 Naturally, in this display update, the parameter setting screen 20 is switched from the display of FIG. 6D to the display of FIG. 5D, which is the reverse of the conversion to the base coordinate system. That is, as a result of the coordinate system calculation by switching the coordinate system, the offset amount of Z-axis "-30 mm" in the base coordinate system 104 shown in FIG. It becomes the offset amount of the axis "30 mm". When changing (only) the coordinate system, it is of course not necessary to change the display of the position and orientation of the robot 101 on the virtual environment screen 10 .

以上のように、ベース座標系からツール座標系への切り替えの場合でも、上述と同様に座標系を切り替えたと同時に、ユーザは直ちに自動的に切り替えた座標系方向の相対値パラメータを確認することができる。このため、作業者が例えば人力で行列計算を行う必要がなくなり、工数の削減と人的なミスの低減を図ることができる。 As described above, even when switching from the base coordinate system to the tool coordinate system, the user can immediately check the relative value parameter of the automatically switched coordinate system direction at the same time as the coordinate system is switched as described above. can. For this reason, the operator does not need to manually perform the matrix calculation, and it is possible to reduce man-hours and human error.

(基準となる教示点106の編集)
最後に、基準となる教示点106を編集した場合のオフセット教示点107の処理について図10を用いて説明する。図10は、入力済みのオフセット教示点107の上位ノードに相当する教示点106を変更する場合の制御手順を示している。
(Editing teaching point 106 as a reference)
Finally, the processing of the offset teaching point 107 when the teaching point 106 serving as the reference is edited will be described with reference to FIG. FIG. 10 shows a control procedure for changing the taught point 106 corresponding to the upper node of the offset taught point 107 that has already been input.

なお、基準となる教示点106の編集を行うパラメータ設定画面20は、絶対値設定部201と、相対値設定部202が表示されているものとする(例えば図5(a)~(d)または図6(a)~(d))。図7(b)の管理画面40に示したように、オフセット教示点107は、基準(親)となる教示点106の子のモデルの関係を保持している。 It is assumed that the parameter setting screen 20 for editing the reference taught point 106 displays an absolute value setting section 201 and a relative value setting section 202 (for example, FIGS. 5A to 5D or 6(a)-(d)). As shown in the management screen 40 of FIG. 7B, the offset teaching point 107 holds the child model relationship of the teaching point 106 serving as the reference (parent).

そのため、このような階層構造のデータでは、基準となる教示点106を編集すると、CPU33はオフセット教示点107も相対値関係を保持した状態で変更しなければならない。 Therefore, in such hierarchically structured data, when the reference teaching point 106 is edited, the CPU 33 must also change the offset teaching point 107 while maintaining the relative value relationship.

まず、管理画面40の基準となる教示点106の編集開始(図10のステップS17)は、例えば、管理画面40(図7(a))において、基準となる教示点106(P001)を操作入力部Dのマウスでクリックすることなどにより指定する。 First, to start editing the teaching point 106 that serves as a reference on the management screen 40 (step S17 in FIG. 10), for example, the teaching point 106 (P001) that serves as a reference is operated and input on the management screen 40 (FIG. 7A). Designation is performed by clicking with the mouse in part D or the like.

これにより、CPU33は、パラメータ設定画面20の教示点名設定部212の表示を教示点106に相当する「P001」に切り替え、当該の教示点106の位置姿勢データを読み出して絶対値設定部201に表示する。 As a result, the CPU 33 switches the display of the taught point name setting section 212 of the parameter setting screen 20 to "P001" corresponding to the taught point 106, reads the position/orientation data of the taught point 106, and displays it in the absolute value setting section 201. do.

この段階で、ユーザは絶対値設定部201の数値を操作入力部Dのキーボードなどを用いて変更することにより、基準となる教示点106の位置を修正する(図10のステップS18)。基準となる教示点106の編集操作を行うと、CPU33の計算部34の機能により、基準となる教示点106に関する位置姿勢演算を行う。 At this stage, the user corrects the position of the reference taught point 106 by changing the numerical value of the absolute value setting section 201 using the keyboard of the operation input section D (step S18 in FIG. 10). When the teaching point 106 serving as a reference is edited, the function of the calculation unit 34 of the CPU 33 performs position and orientation calculation for the teaching point 106 serving as a reference.

また、本実施例では、上述のように基準となる教示点106と、オフセット教示点107は階層的なノード構造によって記憶装置35に格納される。このため、CPU33は前述のような位置姿勢データの格納形式やそのデータ内容などを介して、教示点106は親のノードであり、その下位に影響を受けるノードとしてオフセット教示点107が格納されていることを認識する。 Further, in this embodiment, as described above, the reference teaching point 106 and the offset teaching point 107 are stored in the storage device 35 in a hierarchical node structure. For this reason, the CPU 33 determines that the taught point 106 is a parent node and the offset taught point 107 is stored as a node that is affected by the teaching point 106 through the storage format and data contents of the position and orientation data as described above. recognize that there are

そこで、基準となる教示点106の編集操作を行うと、CPU33の計算部34の機能により、オフセット教示点107に関しても位置姿勢演算を行う(関節値計算処理:図10のS4、およびS5またはS6)。 Therefore, when the teaching point 106 serving as the reference is edited, the function of the calculation unit 34 of the CPU 33 also performs the position and orientation calculation for the offset teaching point 107 (joint value calculation processing: S4 and S5 or S6 in FIG. 10). ).

ここでは、まず、基準となる教示点106に対して子のモデルの関係にあるオフセット教示点107の記述形式に用いられている座標系がツール座標系105か否かを判断する(図10ステップS4)。上述のように、オフセット教示点107に関しては、記憶装置35にその教示点を記述している座標系を示すデータが格納されており、この座標系データを参照することによりこのステップS4の判定を行うことができる。 Here, first, it is determined whether or not the coordinate system used in the description format of the offset teaching point 107, which is in a child model relationship with respect to the reference teaching point 106, is the tool coordinate system 105 (step 10 in FIG. 10). S4). As described above, with respect to the offset teaching point 107, data indicating the coordinate system describing the teaching point is stored in the storage device 35, and the determination in step S4 is performed by referring to this coordinate system data. It can be carried out.

ステップS4において、オフセット教示点107を記述している座標系がツール座標系105である場合、ステップS5に移行する。ステップS5では、基準となる教示点106の修正(ステップS18)の結果に基づき、オフセット教示点107のツール座標系105における位置姿勢演算を行う(ステップS5)。 In step S4, if the coordinate system describing the offset teaching point 107 is the tool coordinate system 105, the process proceeds to step S5. In step S5, the position and orientation of the offset teaching point 107 in the tool coordinate system 105 are calculated (step S5) based on the result of correction of the reference teaching point 106 (step S18).

一方、ステップS4において、オフセット教示点107を記述している座標系がベース座標系104である場合は、ステップS6に移行する。ステップS6では、基準となる教示点106の修正(ステップS18)の結果に基づき、オフセット教示点107のベース座標系104における位置姿勢演算を行う(ステップS6)。 On the other hand, if the coordinate system describing the offset teaching point 107 is the base coordinate system 104 in step S4, the process proceeds to step S6. In step S6, the position and orientation of the offset teaching point 107 in the base coordinate system 104 are calculated (step S6) based on the result of correction of the reference teaching point 106 (step S18).

なお、ステップS5またはS6においては、ロボット101の各関節に係る関節値計算処理も行うが、その場合、子のモデルとして複数のオフセット教示点107が存在する場合、その教示点分すべてに関する関節値計算を行う。 Note that in step S5 or S6, joint value calculation processing for each joint of the robot 101 is also performed. do the math.

続いて、CPU33は、ステップS5またはS6で計算したオフセット教示点107を実現するためのロボット101の各関節値が前述のハードウェアや仕様上の制約内か否かを判断する(制約判断処理、ステップS7)。 Subsequently, the CPU 33 determines whether or not each joint value of the robot 101 for realizing the offset teaching point 107 calculated in step S5 or S6 is within the aforementioned hardware and specification restrictions (constraint determination processing, step S7).

ステップS7において、ロボット101の各関節値が上記の制約内の場合には、ステップS9においてCPU33は表示装置Cの表示画面Eを更新する(正常系表示処理)。同時に、仮想環境画面10のロボット101の表示は直ちに(あるいは管理画面40で教示点が指定された場合)当該の教示点に対応する位置姿勢に変更することができる。 In step S7, when each joint value of the robot 101 is within the above restrictions, in step S9, the CPU 33 updates the display screen E of the display device C (normal system display processing). At the same time, the display of the robot 101 on the virtual environment screen 10 can be changed immediately (or when the teaching point is specified on the management screen 40) to the position and orientation corresponding to the teaching point.

一方、ステップS7において、ロボット101の各関節値が上記制約を超えている場合には、ステップS19において、CPU33は表示装置Cの表示画面Eを用いてエラー表示を行う。このエラー表示の一例としては、例えば図7(c)に示すように、管理画面40を用いて、移動できない教示点であることを示すために、教示点107にマーク108(例えば図示のようなx印)を表示する(異常表示処理)。 On the other hand, if each joint value of the robot 101 exceeds the above constraint in step S7, the CPU 33 uses the display screen E of the display device C to display an error in step S19. As an example of this error display, for example, as shown in FIG. x mark) is displayed (abnormal display processing).

なお、ここでは基準となる教示点106に対して子のノードにあたる教示点は教示点107(P100)のみであるが、CPU33は、同様の演算処理によって他の教示点と上記の制約範囲の関係を検査することができる。従って、子のノードの関係を有する教示点が他にもあって、そのいずれかが可動範囲外の教示点であると判定された場合には、CPU33はその教示点についても図7(c)と同様にマーク108を表示する。このような表示によって、ユーザは今、実行した基準となる教示点106の変更の妥当性(あるいは問題点)を直ちに認識することができる。 In this case, only the taught point 107 (P100) is a child node of the taught point 106 serving as the reference. can be inspected. Therefore, if there are other teaching points that have a child node relationship and one of them is determined to be a teaching point outside the movable range, the CPU 33 also determines that teaching point as shown in FIG. A mark 108 is displayed in the same manner as . With such a display, the user can immediately recognize the validity (or problem) of the change of the teaching point 106 that is now executed as a reference.

上記の管理画面40の表示を確認したユーザは、確定ボタン209(図5、図6)をマウスでクリックすることにより、基準となる教示点106の編集内容を確定することができる(ステップS20)。CPU33は、変更内容を記憶装置35上の教示データに反映させる。あるいは、変更内容を反映させた教示データは、ファイルFの形式で外部装置に送信することもできる。また、基準となる教示点106の編集をキャンセルしたい場合は、キャンセルボタン210(図5、図6)をクリックする。このキャンセル操作が行われた場合には、CPU33は変更内容を破棄して、表示装置Cの表示を編集前の状態に復帰させる。 After confirming the display of the management screen 40, the user can confirm the edited content of the reference teaching point 106 by clicking the confirmation button 209 (FIGS. 5 and 6) with the mouse (step S20). . The CPU 33 reflects the changed content in the teaching data on the storage device 35 . Alternatively, the teaching data reflecting the changed contents can be transmitted to the external device in a file F format. To cancel the editing of the teaching point 106 that serves as the reference, click the cancel button 210 (FIGS. 5 and 6). When this cancel operation is performed, the CPU 33 discards the changed content and restores the display on the display device C to the state before editing.

例えば、編集終了後、管理画面40において、特定の教示点を選択した場合には、CPU33は仮想環境画面10のロボット101の表示を当該の教示点に対応する位置姿勢に変更することができる。また、管理画面40で、移動不可能を示すマーク108が表示されている状態で、その教示点を選択した場合には、CPU33は、例えば表示装置Cにエラー画面50(図8)を表示してエラーをユーザに報知する。この場合は、CPU33仮想環境画面10のロボット101の表示は当該の教示点に対応する位置姿勢に変化させる表示制御を実行する必要はない。 For example, when a specific teaching point is selected on the management screen 40 after editing, the CPU 33 can change the display of the robot 101 on the virtual environment screen 10 to the position and orientation corresponding to the teaching point. Further, when the teaching point is selected while the mark 108 indicating that the movement is impossible is displayed on the management screen 40, the CPU 33 displays an error screen 50 (FIG. 8) on the display device C, for example. to inform the user of the error. In this case, it is not necessary to perform display control to change the display of the robot 101 on the virtual environment screen 10 by the CPU 33 to the position and orientation corresponding to the teaching point.

以上のようにして、基準となる教示点106の編集、および修正を行うことができる。
上述のように、本実施例では、基準となる教示点106に関して、子の関係を有するノードに例えばオフセット教示点107を階層的なノード形式で格納するようにしている。このため、教示点106が変更された場合には、CPU33は直ちに教示点107に関する位置姿勢演算を自動的に実行し、その結果を表示画面Eに反映させることができる。
As described above, the reference teaching point 106 can be edited and corrected.
As described above, in this embodiment, for example, the offset teaching point 107 is stored in a hierarchical node format in a node having a child relationship with respect to the teaching point 106 serving as a reference. Therefore, when the taught point 106 is changed, the CPU 33 can immediately and automatically execute the position/orientation calculation for the taught point 107 and reflect the result on the display screen E. FIG.

これにより、ユーザは基準となる教示点106の編集を行うだけで、関連するオフセット教示点107の位置姿勢に関する影響を編集経過中にリアルタイムで確認でき、作業工数の削減を図ることができる。 As a result, the user can confirm the influence of the position and orientation of the related offset teaching point 107 in real time during the course of editing by simply editing the reference teaching point 106, thereby reducing the number of man-hours.

以上の通り、本実施例によれば、情報処理装置Aにおけるロボット装置の位置姿勢データの入力ないし編集において、作業者は容易にオフセット教示点107や基準となる教示点106の作成、編集、座標系の切り替えなどを行うことができる。本実施例では、編集結果に基づき、ロボット装置に関する位置姿勢演算が自動的に実行される。そして、その結果は、直ちに表示装置Cの表示画面E、パラメータ設定画面20の数値表示や、仮想環境画面10の位置姿勢表示、管理画面40の管理表示に反映される。従って、ユーザは面倒な人力による計算などを行うことなく、表示装置Cの表示画面Eを介して、たった今実行したロボット装置の位置姿勢データの入力ないし編集の妥当性を確認することができ、作業工数の削減や、人的なミスの低減が可能となる。 As described above, according to this embodiment, in inputting or editing the position and orientation data of the robot device in the information processing device A, the operator can easily create, edit, and coordinate the offset taught point 107 and the reference taught point 106 . System switching and the like can be performed. In this embodiment, the position and orientation calculations for the robot device are automatically executed based on the editing result. Then, the result is immediately reflected on the display screen E of the display device C, the numerical display of the parameter setting screen 20 , the position/orientation display of the virtual environment screen 10 , and the management display of the management screen 40 . Therefore, the user can check the validity of the input or editing of the position and orientation data of the robot apparatus that has just been executed through the display screen E of the display apparatus C without performing troublesome manual calculations. It is possible to reduce man-hours and reduce human errors.

本実施例においては、ロボット制御データ(教示データ)としての位置姿勢データのノードを階層的なツリー構造によって記憶装置35に格納するデータ構造を採用している。
例えば、オフセット教示点と、その基準となる教示点、のように親、子の関係にあるデータを従来のような単なるフラットなデータ構造として格納するのではなく、階層的なノード構造で記憶装置に格納する。これにより、位置姿勢データの入力、編集、修正などが行われた場合、即座に影響のある位置姿勢データの範囲を特定でき、その範囲にある位置姿勢データの軌道計算などを含むエラーチェックを行うことができる。
In this embodiment, a data structure is adopted in which nodes of position and orientation data as robot control data (teaching data) are stored in the storage device 35 in a hierarchical tree structure.
For example, instead of storing data in a parent-child relationship such as an offset teaching point and its reference teaching point as a simple flat data structure as in the past, a hierarchical node structure is stored in the storage device. store in As a result, when position/orientation data is input, edited, or modified, the range of position/orientation data that will be affected can be identified immediately, and error checks including trajectory calculations for position/orientation data within that range can be performed. be able to.

また、本実施例によれば、位置姿勢データのノードを階層的に配置したツリー構造の格納形式を採用している。このため、教示点に係る位置姿勢データの入力、編集、修正の過程で、例えば仮想表示出力や数値表示、管理表示などのうち更新すべき部分を迅速かつ確実に特定することができる。そして、実行中の入力、編集、修正の経過をほぼその操作に応じてリアルタイムで確認できるよう、仮想表示出力や数値表示、管理表示などを更新することができる。 Further, according to the present embodiment, a tree structure storage format in which nodes of position and orientation data are hierarchically arranged is employed. Therefore, in the process of inputting, editing, and correcting the position/orientation data related to the teaching points, it is possible to quickly and reliably specify the portion to be updated among, for example, virtual display output, numerical display, and management display. Virtual display output, numerical display, management display, etc. can be updated so that the progress of inputting, editing, and correction during execution can be confirmed in real time according to the operation.

また、本実施例によれば、位置姿勢データの入力、編集、修正では、オフセットとなる相対値による位置姿勢データの指定や、複数のロボット座標系から把握の容易なロボット座標系を任意に用いることができる。オフセットによる相対値により位置姿勢データを入力、編集した場合は、上記の階層的なノード構造の格納形式を利用して、入力、編集に応じた位置姿勢演算を行って例えば仮想表示出力や数値表示、管理表示などを迅速かつ確実に更新することができる。 Further, according to the present embodiment, in inputting, editing, and correcting position/orientation data, position/orientation data can be designated by relative values that serve as offsets, or a robot coordinate system that can be easily grasped from a plurality of robot coordinate systems can be arbitrarily used. be able to. When position and orientation data are input and edited using relative values by offset, the storage format of the hierarchical node structure described above is used to perform position and orientation calculations according to the input and editing, for example, virtual display output and numerical display. , management display, etc. can be updated quickly and reliably.

なお、以上では選択できる座標系としてベース座標系104とツール座標系105の2種類を示したが、対象のロボット装置について他の座標系、例えばロボットの他の特定部位などを基準とした座標系が用いられる場合がある。その場合には、座標系の選択肢には上記のベース座標系104とツール座標系105以外の座標系を含めることができる。例えば、ロボット101が2台存在し、2台のロボット101で協調動作を行う場合、他方のロボット101の動作に合わせるため、他方のロボット101のベース座標系104やツール座標系105を選択できるようにすることが考えられる。また、ワーク103の原点を座標系とするワーク座標系が存在する場合、ワーク座標系を選択できるよう、表示画面EのGUIを設計することができる。これらの座標系に関する変形例は、後述の各実施例においても同様に実施できる。 In the above description, the base coordinate system 104 and the tool coordinate system 105 are shown as the coordinate systems that can be selected. is sometimes used. In that case, the coordinate system options can include coordinate systems other than the base coordinate system 104 and the tool coordinate system 105 described above. For example, when there are two robots 101 and the two robots 101 perform a cooperative operation, the base coordinate system 104 and tool coordinate system 105 of the other robot 101 can be selected to match the operation of the other robot 101. can be considered to be Further, when there is a work coordinate system having the origin of the work 103 as a coordinate system, the GUI of the display screen E can be designed so that the work coordinate system can be selected. Modified examples regarding these coordinate systems can be implemented in the same manner in each embodiment described later.

以下、本発明の情報処理装置および情報処理方法に関して、いくつかの異なる実施例を示す。以下では、同一の構成部材に関しては同一の参照符号を用い、その詳細な説明は省略するものとする。また、後述のフローチャートで示す制御手順においては、例えば前述の図3と同等のステップには同一のステップ番号を用いる。そして、後述の各フローチャート中のステップ番号と、上述の例えば第1の演算工程、第2の演算工程や、表示更新工程との関係は、前述の図3と同等であるものとする。 Several different embodiments of the information processing apparatus and information processing method of the present invention are shown below. Below, the same reference numerals will be used for the same constituent members, and detailed description thereof will be omitted. Also, in the control procedure shown in the flow charts described later, the same step numbers are used for steps that are the same as those in FIG. 3 described above, for example. The relationship between the step numbers in each flow chart to be described later and the above-described, for example, the first calculation process, the second calculation process, and the display update process is the same as that in FIG. 3 described above.

以下、本発明の実施例2に係る情報処理装置および情報処理方法につき、図11から図16を参照して説明する。以下では、上述の実施例1とハードウェア的な構成、および表示画面の構成などのうち基本的な部分は同一であるものとし、その詳細な説明は省略する。また、以下の実施例において、同一ないし相当する部材には同一の参照符号を用い、その詳細な説明は省略するものとする。 An information processing apparatus and an information processing method according to a second embodiment of the present invention will be described below with reference to FIGS. 11 to 16. FIG. In the following description, it is assumed that the basic parts of the hardware configuration, the configuration of the display screen, etc. are the same as those of the first embodiment described above, and detailed description thereof will be omitted. In addition, in the following embodiments, the same reference numerals are used for the same or corresponding members, and detailed description thereof will be omitted.

上記実施例1において、基準となる教示点106は、例えばロボット101のベース座標系104からの相対値により記述された教示点である。この場合、例えばワーク103の位置姿勢が変更された場合、仮想環境内のワーク103の位置姿勢の変更と、それに関連する基準となる教示点106の位置姿勢の編集が別に必要となる。従って、ワーク103の位置姿勢の変更に応じて基準となる教示点106の位置姿勢を自動的に編集できれば便利である。 In the first embodiment, the reference taught point 106 is a taught point described by a relative value from the base coordinate system 104 of the robot 101, for example. In this case, for example, when the position and orientation of the work 103 are changed, it is necessary to change the position and orientation of the work 103 in the virtual environment and to edit the position and orientation of the teaching point 106 that serves as a reference. Therefore, it would be convenient if the position and orientation of the reference taught point 106 could be automatically edited according to the change in the position and orientation of the workpiece 103 .

そこで、本実施例では、管理画面40によるモデル情報管理で、ワーク103に関連した基準となる教示点109およびオフセット教示点110(図11(a)、(b))を管理する手法を例示する。本実施例では、例えばワーク103の位置姿勢の編集を行った時、関連する教示点を一括して自動的に編集できるようにする。 Therefore, in the present embodiment, a method of managing the reference taught point 109 and the offset taught point 110 (FIGS. 11A and 11B) related to the workpiece 103 by model information management using the management screen 40 will be exemplified. . In this embodiment, for example, when the position and orientation of the workpiece 103 are edited, the related teaching points can be automatically edited collectively.

ワーク103に関連したオフセット教示点110の編集処理については、表示装置Cの表示画面EのGUIの選択手順によって異なる処理と表示を行う。例えば、ワーク103に関連した教示点情報の編集については、「オフセット教示点110を編集した場合」と、「ワーク103の編集した場合」の2つのケースについて以降説明する。 As for the edit processing of the offset teaching point 110 related to the work 103, different processing and display are performed depending on the selection procedure of the GUI on the display screen E of the display device C. FIG. For example, editing of the teaching point information related to the work 103 will be described below for two cases of "editing the offset teaching point 110" and "editing the work 103".

なお、実施例1で説明した「座標系を切り替えた場合」と、「基準となる教示点106を編集した場合」の処理に関しては、実施例1と同様の処理を行うものとする。 It should be noted that the same processing as in the first embodiment is performed for the processing "when the coordinate system is switched" and "when the reference taught point 106 is edited" described in the first embodiment.

(ワーク103に関連したオフセット教示点110の編集処理)
まず、1つ目のケース、ワーク103に関連したオフセット教示点110の編集手順と処理について図11および図12を参照して説明する。情報処理装置Aの表示装置Cの表示画面Eにおいて表示する図11(a)は管理画面40の構成を示している。表示画面Eの他の部分には、例えば図1などに示したように仮想環境画面10やパラメータ設定画面20を配置することができる。
(Editing processing of offset teaching point 110 related to work 103)
First, the editing procedure and processing of the offset teaching point 110 related to the workpiece 103 in the first case will be described with reference to FIGS. 11 and 12. FIG. FIG. 11(a) displayed on the display screen E of the display device C of the information processing device A shows the configuration of the management screen 40. FIG. In other parts of the display screen E, the virtual environment screen 10 and the parameter setting screen 20 can be arranged as shown in FIG. 1, for example.

図11(a)の管理画面40に対応する教示データでは、階層的なノード構成でROOT(100)のノード以下にロボット101(ROBOT)およびワーク103(Work)の各教示データのノードが格納されている。ロボット101の各ノードは、基準となる教示点106(P001)と、その子のノードであるオフセット教示点107、TCP(105)およびTool(102)の各ノードである。 In the teaching data corresponding to the management screen 40 of FIG. 11(a), each teaching data node of the robot 101 (ROBOT) and the work 103 (Work) is stored under the ROOT (100) node in a hierarchical node configuration. ing. Each node of the robot 101 is a reference teaching point 106 (P001) and its child nodes, the offset teaching point 107, TCP (105) and Tool (102).

図11(a)のように、本実施例では、ワーク103のモデル情報の子のモデルとして基準となる教示点109、およびオフセット教示点110のノードが階層化されて記憶装置35に格納されている。CPU33(図2)は、このようなデータ構造を利用して、これらの関連(紐)づけられた各ノードの位置姿勢データを管理することができる。 As shown in FIG. 11(a), in this embodiment, nodes of the teaching point 109 and the offset teaching point 110, which serve as the child model of the model information of the workpiece 103, are hierarchized and stored in the storage device 35. there is The CPU 33 (FIG. 2) can use such a data structure to manage the position and orientation data of each of these associated (stringed) nodes.

ここで、ワーク103の基準となる教示点109は、例えばロボット101でワーク103を把持位置などの特定部位の位置姿勢データである。また、オフセット教示点110は、基準となる教示点109の位置姿勢に対するオフセットの相対値で表現された位置姿勢を有する。 Here, the teaching point 109 serving as the reference of the workpiece 103 is position and orientation data of a specific part such as a gripping position of the workpiece 103 by the robot 101 . Also, the offset teaching point 110 has a position and orientation expressed by a relative value of the offset with respect to the position and orientation of the teaching point 109 serving as a reference.

基準となる教示点109とオフセット教示点110は、上記実施例の基準となる教示点106とオフセット教示点107の場合と同様に階層的なノード構造をもって記憶装置35に格納される。このため、上記実施例の基準となる教示点106とオフセット教示点107の場合と同様な編集、およびその編集に関連した表示制御を行うことができる。 The reference teaching point 109 and the offset teaching point 110 are stored in the storage device 35 in a hierarchical node structure, like the reference teaching point 106 and the offset teaching point 107 in the above embodiment. Therefore, it is possible to perform the same editing as in the case of the reference teaching point 106 and the offset teaching point 107 in the above embodiment, and the display control related to the editing.

オフセット教示点110の編集は、以下に例示するような手順で行うことができる。図12は、オフセット教示点110を編集する場合のCPU33が実行する制御手順である。 Editing of the offset teaching point 110 can be performed in the following procedure. FIG. 12 shows the control procedure executed by the CPU 33 when editing the offset teaching point 110 .

図12のステップS12において、管理画面40のオフセット教示点110(P110)を選択して、編集を開始する(S12)。この教示点選択は、前述同様に、管理画面40のオフセット教示点110(P110)を操作入力部Dのマウスによりクリックすることにより行うことができる。 At step S12 in FIG. 12, the offset teaching point 110 (P110) on the management screen 40 is selected to start editing (S12). This teaching point selection can be performed by clicking the offset teaching point 110 (P110) on the management screen 40 with the mouse of the operation input unit D, as described above.

図1に示したように表示装置Cの表示画面Eには、管理画面40とともにパラメータ設定画面20を用意しておく。CPU33は管理画面40でオフセット教示点110(P110)が選択されると、前述と同様に教示点名設定部212の表示を教示点110に相当する「P110」に切り替える。 As shown in FIG. 1, the parameter setting screen 20 is prepared together with the management screen 40 on the display screen E of the display device C. FIG. When the offset teaching point 110 (P110) is selected on the management screen 40, the CPU 33 switches the display of the teaching point name setting section 212 to "P110" corresponding to the teaching point 110 in the same manner as described above.

次に、パラメータ設定画面20の相対値設定部202を用いてオフセット教示点110のオフセットとなる相対値を編集することができる(パラメータ設定手段、ステップS3)。ユーザが相対値設定部202を用いてオフセット教示点110のオフセットとなる相対値を入力ないし編集すると、CPU33の計算部34の機能により座標系変換を伴なう位置姿勢演算を行う。 Next, using the relative value setting section 202 of the parameter setting screen 20, the relative value to be the offset of the offset teaching point 110 can be edited (parameter setting means, step S3). When the user uses the relative value setting unit 202 to input or edit the relative value that will be the offset of the offset teaching point 110, the function of the calculation unit 34 of the CPU 33 performs position/orientation calculation accompanied by coordinate system conversion.

まず、ステップS21において、CPU33はワーク103に関連した教示点かを判断する(モデル判断処理、ステップS21)。この判定は、図11のような階層的なノード構造の教示点データを探索して、処理対象のノード(教示点110)が(例えばロボット101やワーク103のツリーなどの)どの階層(ツリー)に属しているかを特定する処理に相当する。具体的な手法としては、例えば教示点110それ自身の親のモデル情報を根のモデル情報となる絶対座標系100まで検索し、親のモデル情報にロボット101が存在しない場合、ワーク103に関連した教示点と判断する。 First, in step S21, the CPU 33 determines whether the teaching point is related to the workpiece 103 (model determination processing, step S21). This determination is made by searching the teaching point data of the hierarchical node structure as shown in FIG. It corresponds to the process of identifying whether it belongs to As a specific method, for example, the model information of the parent of the teaching point 110 itself is searched up to the absolute coordinate system 100 as the model information of the root. Judged as a teaching point.

この例では、教示点110がステップS21でワーク103に関連した教示点であると判定し、ステップS22を実行する。ステップS22では、ロボット101のベース座標系104から基準となる教示点109までの相対値を計算する(ベース相対値計算処理)。 In this example, it is determined in step S21 that the taught point 110 is a taught point related to the workpiece 103, and step S22 is executed. In step S22, a relative value from the base coordinate system 104 of the robot 101 to the reference teaching point 109 is calculated (base relative value calculation processing).

ここでは、次式(11)の如く、絶対座標系からワーク103までの絶対値の姿勢行列Tと、ワーク103から基準となる教示点109までの相対値の姿勢行列Tの積から、絶対座標系から基準となる教示点109の絶対値の姿勢行列Ttmp7を計算する。 Here, as shown in the following equation (11), from the product of the attitude matrix T4 of absolute values from the absolute coordinate system to the work 103 and the attitude matrix T5 of relative values from the work 103 to the reference teaching point 109, A posture matrix T_tmp7 of the absolute values of the taught point 109 serving as a reference is calculated from the absolute coordinate system.

Figure 0007322099000011
Figure 0007322099000011

次に、次式(12)のように、式(11)の計算結果と絶対座標系からロボット101のベースまでの絶対値の姿勢行列Tの逆行列の積から、ロボット101のベース座標系104から基準となる教示点109までの相対値の姿勢行列Tを計算する。 Next, as shown in the following equation (12), the base coordinate system of the robot 101 is obtained from the product of the calculation result of the equation (11) and the inverse matrix of the absolute value posture matrix T6 from the absolute coordinate system to the base of the robot 101. A posture matrix T1 of relative values from 104 to a reference teaching point 109 is calculated.

Figure 0007322099000012
Figure 0007322099000012

ステップS22に続き、あるいはステップS21において処理対象の教示点がロボット101のベース座標系104に関連した教示点の場合には、ステップS4の処理を実行する。このステップS4では、CPU33がパラメータ設定画面20の座標系選択部204(例えば図5(b))で選択されている座標系がツール座標系105か否か判断する(ステップS4)。 Following step S22, or when the teaching point to be processed is a teaching point related to the base coordinate system 104 of the robot 101 in step S21, the processing of step S4 is executed. In this step S4, the CPU 33 determines whether or not the coordinate system selected in the coordinate system selection section 204 (for example, FIG. 5B) of the parameter setting screen 20 is the tool coordinate system 105 (step S4).

ステップS4で選択されている座標系がツール座標系105の場合、ステップS5に進み、実施例1の場合と同様にツール座標系105におけるロボット101の各関節に関する位置姿勢計算を実行する(関節値計算処理:ステップS5)。 If the coordinate system selected in step S4 is the tool coordinate system 105, the process advances to step S5 to execute the position/orientation calculation for each joint of the robot 101 in the tool coordinate system 105 (joint value Calculation processing: step S5).

一方、ステップS4で選択されている座標系がベース座標系104の場合、ステップS6に進み、実施例1の場合と同様にベース座標系104におけるロボット101の各関節に関する位置姿勢計算を実行する(関節値計算処理:ステップS6)。 On the other hand, if the coordinate system selected in step S4 is the base coordinate system 104, the process advances to step S6 to execute the position/orientation calculation for each joint of the robot 101 in the base coordinate system 104 as in the first embodiment ( Joint value calculation processing: step S6).

次に、ステップS7以降で、ステップS5またはS6の位置姿勢計算の結果に応じて表示画面Eの表示を更新する(表示手段)。 Next, in step S7 and after, the display of the display screen E is updated according to the result of the position/orientation calculation in step S5 or S6 (display means).

まず、ステップS7では、CPU33は、上述の実施例1と同様に、オフセット教示点110に基準部位を移動させる場合に必要なロボット101の各関節値がハードウェアや仕様、規約などにより定まる制約内か判断する(制約判断処理:ステップS7)。 First, in step S7, the CPU 33 determines that each joint value of the robot 101 required to move the reference part to the offset teaching point 110 is within the constraints determined by the hardware, specifications, conventions, etc., as in the first embodiment described above. or not (restriction determination process: step S7).

ステップS7でロボット101の各関節値が上記の制約内であれば、ステップS9に進み、位置姿勢演算の結果に応じてCPU33は表示装置Cの表示画面Eを更新する(正常系表示処理)。同時に、仮想環境画面10のロボット101の表示は、直ちに教示点110に対応する位置姿勢に変更することができる。 If the joint values of the robot 101 are within the above constraints in step S7, the process proceeds to step S9, and the CPU 33 updates the display screen E of the display device C according to the result of position/orientation calculation (normal system display processing). At the same time, the display of the robot 101 on the virtual environment screen 10 can be immediately changed to the position and orientation corresponding to the teaching point 110 .

一方、ステップS7でロボット101の各関節値が上記制約を超えている場合には、ステップS8に進み、ロボット101の姿勢が取れない旨を表示すべく、前述の図8のエラー画面50を表示し(異常系表処理)、編集前の状態に戻る。 On the other hand, if the joint values of the robot 101 exceed the above constraints in step S7, the process proceeds to step S8, and the error screen 50 of FIG. 8 is displayed to indicate that the robot 101 cannot take a posture. (abnormal table processing) and return to the state before editing.

その後、仮想環境画面10のロボット101の表示と、パラメータ設定画面20の表示を視認したユーザは、確定ボタン209(図5、図6)をマウスでクリックすることにより、基準となる教示点110の編集内容を確定することができる(ステップS16)。また、教示点110に関する編集をキャンセルしたい場合は、キャンセルボタン210(図5、図6)をクリックする。このキャンセル操作が行われた場合には、CPU33は変更内容を破棄して、表示装置Cの表示を編集前の状態に復帰させる。 After that, the user who visually recognizes the display of the robot 101 on the virtual environment screen 10 and the display of the parameter setting screen 20 clicks the confirmation button 209 (FIGS. 5 and 6) with a mouse to set the reference teaching point 110. Edited contents can be confirmed (step S16). If the user wishes to cancel the editing of the teaching point 110, he/she clicks the cancel button 210 (FIGS. 5 and 6). When this cancel operation is performed, the CPU 33 discards the changed content and restores the display on the display device C to the state before editing.

以上のようにして、ユーザはワーク103に関連したオフセット教示点110の編集作業を行うと、直ちにロボット101の位置姿勢と教示点のパラメータをすぐに確認できる。これにより、人為的なミスの低減および作業工数の削減を図ることができる。 As described above, when the user edits the offset teaching point 110 related to the workpiece 103, the user can immediately check the position and orientation of the robot 101 and the parameters of the teaching point. As a result, it is possible to reduce human error and man-hours.

(ワーク103の配置変更)
次に、2つ目のケース、ワーク103の配置変更を行う編集処理、およびそれに関連するCPU33による制御例につき図13から図16を参照して説明する。
(Arrangement change of workpiece 103)
Next, the second case, editing processing for changing the layout of the workpiece 103, and an example of control by the CPU 33 related thereto will be described with reference to FIGS. 13 to 16. FIG.

なお、管理画面40に関しては上記の図11(a)、(b)に示した表示を用いる。また、同時に、配置変更を受けるワーク103に関しては、上記の図11および図12の例と同様に基準となる教示点109と、その子のオフセット教示点110のノードが既に定義済みであるものとする。 As for the management screen 40, the displays shown in FIGS. 11A and 11B are used. At the same time, with respect to the workpiece 103 to be rearranged, it is assumed that nodes of the teaching point 109 serving as a reference and its child offset teaching point 110 have already been defined in the same manner as in the examples of FIGS. 11 and 12 above. .

これら基準となる教示点109と、その子のオフセット教示点110のノードは、例えばこのワーク103の把持などの取り扱いを行う場合のロボット101の基準部位の位置姿勢に相当する位置姿勢データを格納している。本例では、教示点109、110のノードはワーク103の階層に格納されているため、ワーク103の位置を変更すれば、CPU33は下記のように影響を受ける教示点109、110のノードを自動的に編集(変更)することができる。 The nodes of these reference teaching point 109 and its child offset teaching point 110 store position and orientation data corresponding to the position and orientation of the reference portion of the robot 101 when handling such as gripping of the workpiece 103, for example. there is In this example, the nodes of the taught points 109 and 110 are stored in the hierarchy of the work 103. Therefore, if the position of the work 103 is changed, the CPU 33 automatically restores the nodes of the taught points 109 and 110 affected as follows. can be edited (changed).

本明細書におけるロボット装置を制御するための位置姿勢データを階層的なノード構成によって記憶装置35に記憶する。例えば関連する教示点(例えば基準の教示点とオフセット教示点)は、階層的に紐づけられてノードとして格納する。このため、特定のノードに関する編集が行われた場合、直ちにその編集の影響範囲内にある他のノードを特定し、編集されたノードに応じてそのノードの新しい値を計算できる。 The position and orientation data for controlling the robot apparatus in this specification are stored in the storage device 35 in a hierarchical node configuration. For example, related teaching points (for example, reference teaching points and offset teaching points) are hierarchically linked and stored as nodes. Therefore, when an edit is made to a particular node, it is possible to immediately identify other nodes within the scope of the edit and to calculate the new value of that node according to the edited node.

また、ロボット101以外の対象、例えばワーク103(の位置姿勢データ)も1つのノードとして記憶装置35中の階層的なデータ構造に記憶させることができる。これにより、ロボット101で取り扱うワーク103のノード(の位置姿勢データ)が編集された場合は、上記同様にロボット101の位置姿勢を演算して、ハードウェアや仕様、規約上の制約との関係をチェックすることができる。そして、エラーが生じていなければ表示画面E中のパラメータ設定画面20や仮想環境画面10の表示を更新することができる。 Further, an object other than the robot 101, for example (the position and orientation data of the work 103) can also be stored in the hierarchical data structure in the storage device 35 as one node. As a result, when the node (position/orientation data of) of the workpiece 103 handled by the robot 101 is edited, the position/orientation of the robot 101 is calculated in the same manner as described above, and the relationship with the hardware, specifications, and restrictions on regulations is determined. can be checked. Then, if no error has occurred, the display of the parameter setting screen 20 and the virtual environment screen 10 in the display screen E can be updated.

図13は、ワーク103の位置姿勢を編集する場合の制御手順を示している。以下、ワーク103の位置姿勢を編集した場合のオフセット教示点110に関する制御につき説明する。 FIG. 13 shows a control procedure for editing the position and orientation of the work 103. As shown in FIG. Below, the control of the offset teaching point 110 when the position and orientation of the work 103 are edited will be described.

また、図14(a)~(c)は、ワーク103の位置姿勢を編集した場合の仮想環境画面10の表示更新の様子を示している。図14(a)は、ワーク103に関連した基準となる教示点109のロボット101の位置姿勢と、ワーク103の配置の関係を表示している。 14A to 14C show how the display of the virtual environment screen 10 is updated when the position and orientation of the work 103 are edited. FIG. 14A shows the relationship between the position and orientation of the robot 101 and the placement of the work 103 at the reference teaching point 109 related to the work 103 .

ワーク103に関する記憶装置35上の階層的なデータ記憶では、基準となる教示点109と、オフセット教示点110が関連している状態とする(例えば図11(a))。 In the hierarchical data storage on the storage device 35 regarding the workpiece 103, the reference teaching point 109 and the offset teaching point 110 are related (for example, FIG. 11(a)).

図13のステップS23においては、まず管理画面40より編集するワーク103を選択し、ワーク103の配置の編集開始を指定する。この操作は、ユーザが図11(a)の管理画面40でワーク103のノードをマウスによりクリックすることにより行えるようGUIを構成しておく。 In step S23 of FIG. 13, first, the work 103 to be edited is selected from the management screen 40, and the start of editing of the placement of the work 103 is designated. The GUI is configured so that the user can perform this operation by clicking the node of the work 103 on the management screen 40 of FIG. 11(a) with the mouse.

図16(a)~(c)は、本例のワーク103のノードの編集に用いられるパラメータ設定画面20の表示状態を示している。この図16(a)~(c)の例では、ワーク103のノードを選択済みであり、パラメータ設定画面20の右側には入力フィールド(ボックス)は表示していない。 16A to 16C show the display state of the parameter setting screen 20 used for editing the node of the work 103 of this example. In the example of FIGS. 16A to 16C, the node of work 103 has already been selected, and no input field (box) is displayed on the right side of parameter setting screen 20. FIG.

ステップS23で管理画面40でワーク103のノードをクリックし、選択すると、CPU33は、パラメータ設定画面20を例えば図16(a)に示すように切り替える。この図16(a)のパラメータ設定画面20は、ワーク103の配置変更を行う前の状態を示している。 When the node of the work 103 is clicked and selected on the management screen 40 in step S23, the CPU 33 switches the parameter setting screen 20, for example, as shown in FIG. 16(a). The parameter setting screen 20 of FIG. 16(a) shows the state before the placement of the work 103 is changed.

この段階で既にワーク103が配置済みであれば、図16(a)のように絶対値設定部201にワーク103を配置したX、Y、Z座標値が表示される。また、このGUI構成では、相対値設定部202には同じX、Y、Z座標値を表示させる。なお、ワーク103に関しては座標系としてはベース座標系が用いられるものとする。 If the work 103 has already been placed at this stage, the X, Y, and Z coordinate values of the work 103 placed in the absolute value setting section 201 are displayed as shown in FIG. 16(a). Also, in this GUI configuration, the same X, Y, and Z coordinate values are displayed in the relative value setting unit 202 . As for the workpiece 103, the base coordinate system is used as the coordinate system.

続いて、図13のステップS24において、ユーザはパラメータ設定画面20を用いてワーク103の配置変更を行うことができる。 Subsequently, in step S24 of FIG. 13, the user can use the parameter setting screen 20 to change the layout of the work 103. FIG.

図16のGUIの例では、相対値設定部202を用いて配置変更を行う。例えば、ユーザは図16(a)のように、相対値設定部202のX座標の設定欄208を操作入力部Dのマウスのカーソル205(ポインタ)でクリックし、この入力フィールドを選択する。 In the GUI example of FIG. 16, the relative value setting unit 202 is used to change the layout. For example, as shown in FIG. 16A, the user clicks the X coordinate setting field 208 of the relative value setting section 202 with the mouse cursor 205 (pointer) of the operation input section D to select this input field.

次に、相対値設定部202のX軸の設定欄208に操作入力部Dキーボードで「300」(mm)という数値を入力し、同キーボードで[Enter]キーを押下する(入力前の数値は「400」)。ここでキーボードの[Enter]キーを押下すると、ワーク103のノードの編集の場合、CPU33は、図16(b)のように相対値設定部202の入力が絶対値設定部201にコピーして表示させる。 Next, enter a numerical value of “300” (mm) in the X-axis setting field 208 of the relative value setting unit 202 using the operation input unit D keyboard, and press the [Enter] key on the same keyboard (the numerical value before input is "400"). When the [Enter] key on the keyboard is pressed here, in the case of editing the node of the work 103, the CPU 33 copies the input of the relative value setting section 202 to the absolute value setting section 201 and displays it as shown in FIG. 16(b). Let

ここで、上記の数値指定によるワーク103の配置変更は、例えば図14(a)の位置から図14(b)の仮想環境画面10においては、右側の位置へワーク103を移動する操作であるものとする。 Here, the change in the placement of the work 103 by specifying the numerical values is an operation of moving the work 103 from the position shown in FIG. 14A to the right position in the virtual environment screen 10 shown in FIG. 14B. and

上記のように、ノードの入力フィールドの1つに入力が行われ、[Enter]キーが押下されると、CPU33は編集内容に応じて当該のノードの位置姿勢データを変更するとともに、この編集に影響を受けるノードの教示点の新たな位置姿勢を演算する。 As described above, when an input is made in one of the input fields of a node and the [Enter] key is pressed, the CPU 33 changes the position and orientation data of the node in accordance with the content of editing, and Compute the new poses of the taught points of the affected nodes.

図11(a)のようなノード構造でワーク103、教示点109(P010)、110(P110)が格納されている場合には、これら教示点109、110の位置姿勢を演算する。 When the workpiece 103 and the teaching points 109 (P010) and 110 (P110) are stored in the node structure as shown in FIG. 11A, the positions and orientations of these teaching points 109 and 110 are calculated.

まず、図13のステップS21において、行われた編集がWorkのツリーに関連した教示点の編集か否かを判断する(モデル判断処理)。ステップS21が肯定された場合にはステップS4に移行する前にステップS22を実行し、否定された場合にはそのままステップS4に移行する。 First, in step S21 of FIG. 13, it is determined whether or not the editing that has been performed is the teaching point editing related to the Work tree (model determination processing). If step S21 is affirmative, step S22 is executed before proceeding to step S4, and if negative, the process proceeds directly to step S4.

例えば、基準となる教示点109およびオフセット教示点110の場合は、ワーク103の下位のノードに格納されているため、ステップS22が実行される。このステップS22では、ベース座標系(104)においてロボット101から基準となる教示点109までの相対値を計算する(ベース相対値計算処理、S22)。 For example, in the case of the reference taught point 109 and the offset taught point 110, since they are stored in the lower nodes of the workpiece 103, step S22 is executed. In this step S22, a relative value from the robot 101 to the reference teaching point 109 is calculated in the base coordinate system (104) (base relative value calculation processing, S22).

続くステップS4~S6は、図3、図10、図12などで説明したものと同様の処理対象の教示点のデータ表現に係る座標系の判定処理である。 The following steps S4 to S6 are coordinate system determination processes related to data representation of the teaching points to be processed, which are similar to those described with reference to FIGS.

まず、ステップS4においては、当該の教示点の位置姿勢データとともに格納されている座標系データが示す座標系がツール座標系105か否かを判断する。 First, in step S4, it is determined whether or not the coordinate system indicated by the coordinate system data stored together with the position/orientation data of the teaching point is the tool coordinate system 105 or not.

ステップS4の判定結果がツール座標系105であれば、ステップS5に進み、図3(あるいは図12)において説明したのと同様にツール座標系105の姿勢計算を実行する(関節値計算処理)。 If the determination result in step S4 is the tool coordinate system 105, the process advances to step S5 to execute posture calculation of the tool coordinate system 105 (joint value calculation processing) in the same manner as described with reference to FIG. 3 (or FIG. 12).

また、ステップS4の判定結果がベース座標系104であれば、ステップS6に進み、図3(あるいは図12)において説明したのと同様にベース座標系104の姿勢計算を実行する(関節値計算処理)。 If the determination result in step S4 is the base coordinate system 104, the process advances to step S6 to execute posture calculation of the base coordinate system 104 (joint value calculation processing) in the same manner as described with reference to FIG. 3 (or FIG. 12). ).

続いて、位置姿勢演算の結果に基づき表示装置Cの表示画面Eの表示を更新する(表示手段)。ステップS7では、基準となる教示点109、ないしオフセット教示点110にロボット101の基準部位を移動させるために必要な各関節値がハードウェアや仕様、規約により定まる制約内か否かを判断する(制約判断処理)。 Subsequently, the display of the display screen E of the display device C is updated based on the result of the position/orientation calculation (display means). In step S7, it is determined whether or not each joint value required to move the reference portion of the robot 101 to the reference teaching point 109 or the offset teaching point 110 is within the constraints determined by the hardware, specifications, and regulations ( constraint judgment processing).

ステップS7でロボット101の位置姿勢(各関節値の状態)が制約内の判定であればステップS9に進み、CPU33は位置姿勢演算の結果に応じて表示装置Cの表示画面Eを更新する(正常系表示処理)。 If it is determined in step S7 that the position and orientation (state of each joint value) of the robot 101 are within the constraints, the process proceeds to step S9, and the CPU 33 updates the display screen E of the display device C according to the result of the position and orientation calculation (normally system display processing).

図14(b)は、ワーク103の配置編集確定後のワーク103と基準となる教示点109、オフセット教示点110の仮想環境画面10における表示状態を示している。ステップS7でロボット101の位置姿勢(各関節値の状態)が制約内の判定であれば、CPU33は仮想環境画面10の表示を図14(b)の状態から図14(c)の状態に更新する。 FIG. 14(b) shows the display state of the workpiece 103 after the layout editing of the workpiece 103 is confirmed, the teaching point 109 serving as the reference, and the offset teaching point 110 on the virtual environment screen 10. FIG. If it is determined in step S7 that the position and orientation (state of each joint value) of the robot 101 are within the constraints, the CPU 33 updates the display of the virtual environment screen 10 from the state shown in FIG. 14(b) to the state shown in FIG. 14(c). do.

ユーザが上記のように切り替えられた表示装置Cの表示画面Eを視認して確認すると、パラメータ設定画面20の確定ボタン209を操作入力部Dのマウスでクリックする。これに応じてCPU33はステップS25で教示点109、110の編集を終了する。また、パラメータ設定画面20のキャンセルボタン210を操作入力部Dのマウスでクリックすると、CPU33は編集内容を破棄し、仮想環境画面10を図14(a)の状態に戻す。 When the user visually confirms the display screen E of the display device C switched as described above, the user clicks the confirmation button 209 on the parameter setting screen 20 with the mouse of the operation input unit D. FIG. In response to this, the CPU 33 ends the editing of the teaching points 109 and 110 in step S25. Further, when the cancel button 210 of the parameter setting screen 20 is clicked with the mouse of the operation input section D, the CPU 33 discards the edited content and returns the virtual environment screen 10 to the state shown in FIG. 14(a).

また、上記のワーク103の配置変更に関する編集完了後、管理画面40のワーク103に関連した基準となる教示点109がマウスのクリックなどにより選択できるようにしておく。この教示点109の選択操作に応じて、CPU33は基準となる教示点109に移動させた状態のロボット101の位置姿勢を仮想環境画面10に表示させることができる。 In addition, after completing the editing related to the layout change of the work 103, the teaching point 109, which is the reference related to the work 103 on the management screen 40, can be selected by clicking the mouse or the like. In response to the instruction point 109 selection operation, the CPU 33 can display the position and orientation of the robot 101 moved to the reference taught point 109 on the virtual environment screen 10 .

以上のように、本実施例によれば、ノードを階層的に格納するツリー構造でロボットの教示データを格納するようにしているため、ワーク103のノードの下位に教示点109、110を格納することができる。このため、ワーク103のノードの位置姿勢を変更すると、CPU33は関連する下位ノードの教示点109、110の位置姿勢データを自動的に計算し、ロボット101の位置姿勢(ないしそれを可能にする各関節値)を自動的に計算することができる。さらに、CPU33はロボット101の位置姿勢(ないしそれを可能にする各関節値)がハードウェアや仕様、規約により定まる制約内か否かを判断することができる。 As described above, according to this embodiment, since the teaching data of the robot is stored in a tree structure in which nodes are stored hierarchically, the teaching points 109 and 110 are stored under the node of the workpiece 103. be able to. Therefore, when the position and orientation of the node of the workpiece 103 are changed, the CPU 33 automatically calculates the position and orientation data of the teaching points 109 and 110 of the associated lower nodes, and the position and orientation of the robot 101 (or each enabling it). joint values) can be automatically calculated. Furthermore, the CPU 33 can determine whether or not the position and orientation of the robot 101 (or each joint value that enables it) are within the constraints determined by the hardware, specifications, and conventions.

なお、上記のワーク103の配置変更後に、教示点109ないし110にロボット101の位置姿勢が取れない場合について説明する。 A case where the position and orientation of the robot 101 cannot be taken at the teaching points 109 to 110 after the placement of the workpiece 103 is changed will be described.

例えば、図16(c)は、パラメータ設定画面20に対するワーク103の配置変更に係わる他の操作を示している。この図16(c)では、相対値設定部202のX軸の設定欄208に操作入力部Dのキーボードで「500」という数値を入力して[Enter]キーを押下している。この操作は、図13のステップS24により処理される。 For example, FIG. 16C shows another operation related to changing the layout of the work 103 on the parameter setting screen 20. FIG. In FIG. 16(c), the numerical value "500" is input in the X-axis setting field 208 of the relative value setting section 202 using the keyboard of the operation input section D, and the [Enter] key is pressed. This operation is processed by step S24 in FIG.

このX軸方向に「500」(mm)のワーク103の位置変更は、上述の図16(b)の「300」(mm)の場合よりも大きな距離の移動である。そして、ここではこのX軸方向に「500」(mm)のワーク103の位置変更に応じて位置姿勢演算を行うと、関節値のいずれかがロボット101のハードウェアや仕様、規約などにより定まる制約範囲を超過するものとする。 This change in position of the workpiece 103 by "500" (mm) in the X-axis direction is a movement of a greater distance than the case of "300" (mm) in FIG. 16B. Here, if the position and orientation calculation is performed according to the position change of the workpiece 103 by "500" (mm) in the X-axis direction, one of the joint values is determined by the hardware, specifications, rules, etc. of the robot 101. Scope shall be exceeded.

このため、上記のX軸方向に「500」(mm)のワーク103の位置変更を行うと、図13のステップS7(制約判断処理)からステップS19(異常系表示処理)への遷移が生じる。そしてステップS9(異常系表示処理)では、CPU33は表示装置Cの表示画面Eを用いてエラー表示を行う。このエラー表示の一例としては、例えば図11(b)に示すように、管理画面40を用いて、管理画面40を用いて、移動できない教示点であることを示すために、教示点109および110にマーク108(例えば図示のようなx印)を表示する。その後の編集終了処理(ステップS25)については、上述と同様に行う。 Therefore, when the position of the workpiece 103 is changed by "500" (mm) in the X-axis direction, a transition occurs from step S7 (restriction judgment processing) in FIG. 13 to step S19 (abnormal system display processing). Then, in step S9 (abnormal system display processing), the CPU 33 uses the display screen E of the display device C to display an error. As an example of this error display, for example, as shown in FIG. mark 108 (eg, an x as shown). The subsequent editing end processing (step S25) is performed in the same manner as described above.

なお、ロボット101の位置姿勢が取れないワーク103の配置変更を行った場合の仮想環境画面10については、図15(a)、(b)のように更新することが考えられる。図15(a)は図14(a)と同等で、ワーク103の配置変更に係る編集処理を行う前の仮想環境画面10である。 It is conceivable to update the virtual environment screen 10 as shown in FIGS. FIG. 15(a) is equivalent to FIG. 14(a) and shows the virtual environment screen 10 before the editing process for changing the layout of the work 103 is performed.

図15(a)の状態から、上述のワーク103の配置変更に係る編集処理を行うと、例えばCPU33は位置姿勢演算の実行中は、図15(b)のように指定された移動量だけワーク103を移動させた状態に仮想環境画面10を更新する。なお、図15(b)では、理解を容易にするため、図14(b)、(c)とは逆方向にワーク103の移動方向を取っている。 15(a), when the editing process for changing the layout of the work 103 is performed, for example, the CPU 33 moves the work 103 by a designated movement amount as shown in FIG. The virtual environment screen 10 is updated to the state where 103 has been moved. In addition, in FIG. 15(b), the moving direction of the work 103 is opposite to that in FIGS. 14(b) and 14(c) for easy understanding.

そして、当該の編集操作に係る位置姿勢演算が終了し、制約範囲に関する判定に入った段階で、図13のステップS7(制約判断処理)からステップS19(異常系表示処理)への遷移が生じる。この場合には、CPU33は、上述のように管理画面40を図8(b)のように更新するとともに、仮想環境画面10の表示状態を図15(b)から図15(a)の状態に復帰させる。その際、仮想環境画面10全体ないしその一部を点滅(フラッシュ)させるような警告表現を併用してもよい。 Then, when the position/orientation calculation related to the editing operation is finished and the restriction range is determined, a transition from step S7 (restriction determination processing) in FIG. 13 to step S19 (abnormal system display processing) occurs. In this case, the CPU 33 updates the management screen 40 as shown in FIG. 8(b), and changes the display state of the virtual environment screen 10 from FIG. 15(b) to the state shown in FIG. 15(a). bring back. At that time, a warning expression such as blinking (flash) the entire virtual environment screen 10 or part thereof may be used together.

以上のようにして、本実施例ロボット制御データ(教示データ)としての位置姿勢データのノードを階層的なツリー構造によって記憶装置35に格納するデータ構造を採用している。この構造によれば、ロボット装置に係る位置姿勢データのみならず、上記のようにワーク103に関する位置姿勢データも、同じツリー構造の中に格納できる。このためワーク103に関する編集を行なった場合に、直ちにツリー構造の教示データ中に他に関連する教示データ(例えばワーク103の教示点109とそのオフセット教示点110)があれば、自動的にそれらの関連する教示データを再計算できる。さらに、ワーク103に関する編集に応じてロボット101の位置姿勢演算を行って、ハードウェアや仕様、規約などにより定まる制約に関する妥当性チェックを自動的に実行できる。 As described above, a data structure is employed in which nodes of position and orientation data as robot control data (teaching data) of this embodiment are stored in the storage device 35 in a hierarchical tree structure. According to this structure, not only the position and orientation data related to the robot device but also the position and orientation data related to the workpiece 103 can be stored in the same tree structure as described above. Therefore, when the work 103 is edited, if there are other related teaching data (for example, the teaching point 109 of the work 103 and its offset teaching point 110) in the teaching data of the tree structure, those teaching data are automatically changed. Related teaching data can be recalculated. Furthermore, the position and orientation of the robot 101 can be calculated in accordance with the editing of the workpiece 103, and validity checks can be automatically performed regarding constraints determined by hardware, specifications, rules, and the like.

そして、教示データおよびロボット101の位置姿勢の再計算の結果、問題が無ければ、編集後、直ちに表示装置Cの仮想環境画面10、パラメータ設定画面20、管理画面40などから成る表示画面を編集操作に応じた内容に自動的に更新することができる。このため、ユーザ(作業者)はワーク103に関連する編集内容ないしその結果をリアルタイムで確認できるようになり、人為的なミスの低減、および工数の削減を図ることが出来る。 Then, if there is no problem as a result of the recalculation of the teaching data and the position and orientation of the robot 101, the display screen composed of the virtual environment screen 10, the parameter setting screen 20, the management screen 40, etc. of the display device C is immediately edited. can be automatically updated according to As a result, the user (operator) can confirm the edited content or the result related to the work 103 in real time, thereby reducing human errors and man-hours.

なお、図11(a)のロボット101(ROBOT)のノードの下位には、基準となる教示点106と、オフセット教示点107が格納されている。そして、教示点106(P001)がワーク103の特定位置に相当する上記の教示点109(P010)に対応し、オフセット教示点107(P100)がオフセット教示点110(P110)に対応するよう取り扱うことが考えられる。このように同じ実体記憶として、基準となる教示点とそのオフセット教示点の組が、ROBOTのツリーとWorkのツリーの両方に格納されているように取り扱えると好ましい。これによりユーザが容易にロボット制御データ全体の構造を把握できるようになると考えられる。 In addition, below the node of the robot 101 (ROBOT) in FIG. 11A, a taught point 106 serving as a reference and an offset taught point 107 are stored. The teaching point 106 (P001) should correspond to the teaching point 109 (P010) corresponding to the specific position of the workpiece 103, and the offset teaching point 107 (P100) should correspond to the offset teaching point 110 (P110). can be considered. In this way, it is preferable that a set of reference teaching points and their offset teaching points be stored in both the ROBOT tree and the Work tree as the same entity storage. It is believed that this will allow the user to easily grasp the structure of the entire robot control data.

その場合、それぞれ対応する教示点106と109、および教示点107と110は、一方を編集したら、他の対応する教示点の内容も同じように自動編集されるようになっていると便利である。このような取り扱いを可能にする手法としては、例えば対応する教示点106と109(または教示点107と110)の実体を記憶装置35上の同じ1つのメモリセルに格納する。そして、この1つのメモリセルのアドレスポインタをROBOTおよびWorkのツリーに、ノードP001とP100(あるいはP010とP110)のノードとして格納する。このような構造によれば、ノードP001とP100(あるいはP010とP110)のいずれかのポインタ経由で、いずれの編集を指示しても同じメモリセルに格納された実体データを編集することができる。 In that case, it would be convenient if the teaching points 106 and 109 and the teaching points 107 and 110 corresponding to each other are automatically edited in the same way when one of them is edited. . As a method for enabling such handling, for example, the entities of corresponding taught points 106 and 109 (or taught points 107 and 110) are stored in the same single memory cell on storage device 35 . Then, the address pointer of this one memory cell is stored in the ROBOT and Work trees as nodes P001 and P100 (or P010 and P110). According to such a structure, it is possible to edit the substance data stored in the same memory cell by instructing either editing via the pointer of either of the nodes P001 and P100 (or P010 and P110).

このように同じメモリデータの実体に異なる複数のポインタ(ないし名前)を介してアクセスする構造を利用すれば、教示データを格納するツリー構造の異なる位置に必要に応じて別名(alias)のノードを用意することができる。これによって、ユーザが容易にロボット制御データ全体の構造を把握でき、1つの同じデータにツリー構造中の複数の異なる位置から到達し、その内容を確実に編集することができる。 Using a structure in which the entity of the same memory data is accessed through multiple different pointers (or names) in this way allows nodes with aliases to be added to different locations in the tree structure that stores the teaching data as needed. can be prepared. This allows the user to easily grasp the structure of the entire robot control data, reach the same piece of data from a plurality of different positions in the tree structure, and reliably edit the content.

なお、同じデータの実体に異なる複数の名前を介してアクセスするための構成は、上記のアドレスポインタに限定されるものではない。例えば、各種ファイルシステムにおいて利用されているジャンクションやシンボリックリンク、ハードリンクなどの「リンク」のメカニズムを利用してもよい。その場合には、特定のノードを1つのファイルとして記憶装置35上に配置されたファイルシステムに格納し、そのリンクを別のノードとしてデータ構造のツリー上の他の位置に配置する。 Note that the configuration for accessing the same entity of data via a plurality of different names is not limited to the above address pointer. For example, "link" mechanisms such as junctions, symbolic links, and hard links used in various file systems may be used. In that case, the particular node is stored as one file in the file system located on the storage device 35, and its link is placed as another node in another location on the tree of the data structure.

以下、本発明の実施例3に係る情報処理装置および情報処理方法につき、図17から図20を参照して説明する。以下では、上述の実施例1とハードウェア的な構成、および表示画面の構成などのうち基本的な部分は同一であるものとし、その詳細な説明は省略する。また、以下の実施例において、同一ないし相当する部材には同一の参照符号を用い、その詳細な説明は省略するものとする。 An information processing apparatus and an information processing method according to a third embodiment of the present invention will be described below with reference to FIGS. 17 to 20. FIG. In the following description, it is assumed that the basic parts of the hardware configuration, the configuration of the display screen, etc. are the same as those of the first embodiment described above, and detailed description thereof will be omitted. In addition, in the following embodiments, the same reference numerals are used for the same or corresponding members, and detailed description thereof will be omitted.

上記の実施例1、および実施例2では、ノード管理されている作業空間上の親から子のモデル情報となる相対値を編集した場合の処理について説明した。しかし、編集は必ずしも相対値で設定するとは限らない。 In the first and second embodiments described above, the processing in the case of editing the relative values that are the model information from the parent to the child on the node-managed work space has been described. However, editing does not always set relative values.

例えば、ツール座標系を選択してオフセット教示点107を作成している時に、複雑な動作の教示を行う場合、状況によって作業空間上などの絶対座標系(例えばベース座標系)の絶対値で設定しなければならない場合が存在する。 For example, when teaching a complicated operation while selecting the tool coordinate system and creating the offset teaching point 107, depending on the situation, set the absolute value of the absolute coordinate system (for example, the base coordinate system) on the work space. There are cases where you have to.

そこで、パラメータ設定画面20の絶対値設定部201の操作で、作業空間上の絶対座標系を用いた絶対値でオフセット教示点107やオフセット教示点110の操作を行う処理について説明する。 Therefore, a process of operating the offset teaching point 107 and the offset teaching point 110 by operating the absolute value setting section 201 of the parameter setting screen 20 with absolute values using the absolute coordinate system on the working space will be described.

絶対値設定部201の操作での編集処理については、対象となる教示点の種類によって異なる処理と表示を行う必要がある。そのため、以下では、「ツール座標系105を選択したオフセット教示点107の場合」、「ベース座標系を選択したオフセット教示点107の場合」、「オフセット教示点110の場合」3つのケースについて説明する。 As for editing processing by operating the absolute value setting unit 201, it is necessary to perform different processing and display depending on the type of target teaching point. For this reason, three cases will be described below: "In the case of the offset teaching point 107 with the tool coordinate system 105 selected," "In the case of the offset teaching point 107 with the base coordinate system selected," and "In the case of the offset teaching point 110." .

(ツール座標系105が選択されたオフセット教示点107の絶対値編集)
まず、1つ目のケース、ツール座標系105が選択されたオフセット教示点107の絶対値編集の手順と制御について、図11、および図17から図19を用いて説明する。
(Absolute value editing of offset teaching point 107 with tool coordinate system 105 selected)
First, the first case, the procedure and control of absolute value editing of the offset teaching point 107 in which the tool coordinate system 105 is selected, will be described with reference to FIGS. 11 and 17 to 19. FIG.

図17は、オフセット教示点107の絶対値編集を行う場合の制御手順を示している。 FIG. 17 shows a control procedure for absolute value editing of the offset teaching point 107 .

図17のステップS12では、管理画面40(図11(a))のオフセット教示点107を選択して、編集を開始する。選択の方法は上述と同様で、管理画面40上の教示点107(P100)のノードを操作入力部Dのマウスでクリックすることなどにより行う。 In step S12 of FIG. 17, the offset teaching point 107 on the management screen 40 (FIG. 11(a)) is selected to start editing. The selection method is the same as described above, and is performed by clicking the node of the teaching point 107 (P100) on the management screen 40 with the mouse of the operation input unit D or the like.

図18(a)、(b)は、本実施例において、オフセット教示点107の絶対値編集を行っている場合に仮想環境画面10に表示されるロボット101の位置姿勢を示している。編集開始時には、オフセット教示点107は、例えば図18(a)に示すように基準となる教示点106に対して定義されている。この時のオフセット(相対距離)は、例えば図示のようにツール102がワーク103に到達するような距離に取られている。このため、仮想環境画面10では、ロボット101は図示のようにツール102がワーク103に到達するような位置姿勢で表示されている。 18A and 18B show the position and orientation of the robot 101 displayed on the virtual environment screen 10 when absolute value editing of the offset teaching point 107 is performed in this embodiment. At the start of editing, the offset teaching point 107 is defined with respect to the reference teaching point 106 as shown in FIG. 18(a), for example. The offset (relative distance) at this time is, for example, such a distance that the tool 102 reaches the workpiece 103 as shown. Therefore, on the virtual environment screen 10, the robot 101 is displayed in such a position and orientation that the tool 102 reaches the workpiece 103 as shown.

また、パラメータの数値設定では、表示装置Cの表示画面Eに図19(a)~(c)に示すようなパラメータ設定画面20を表示して用いる。 19(a) to 19(c) are displayed on the display screen E of the display device C for use in setting numerical values of the parameters.

図17のステップS26において、ユーザはオフセット教示点107の絶対値を編集する(パラメータ設定手段)。図19(a)は、このとき、パラメータ設定画面20の絶対値設定部201の設定欄208へアクセスする操作を示している。即ち、図示のように、絶対値設定部201のX軸の設定欄208を操作入力部Dのマウスのカーソル205でクリックする。 At step S26 in FIG. 17, the user edits the absolute value of the offset teaching point 107 (parameter setting means). FIG. 19A shows an operation for accessing the setting column 208 of the absolute value setting section 201 of the parameter setting screen 20 at this time. That is, as shown in the figure, the X-axis setting field 208 of the absolute value setting section 201 is clicked with the mouse cursor 205 of the operation input section D. FIG.

なお、図19(a)の段階で、教示点名設定部212の表示は教示点107に相当する「P100」に切り替えられている。また、教示点設定部203の値は、基準となる教示点106に対応する「P001」に切り替えられている。また、座標系選択部204の表示の通り、座標系としてはツール座標系が選択されている。 19A, the display of the teaching point name setting section 212 has been switched to "P100" corresponding to the teaching point 107. As shown in FIG. Also, the value of the taught point setting unit 203 is switched to "P001" corresponding to the taught point 106 that serves as the reference. Further, as displayed in the coordinate system selection section 204, the tool coordinate system is selected as the coordinate system.

続いて、ユーザは図19(b)に示すように絶対値設定部201のX軸の設定欄208の内容を「400」から「300」に変更する。ここでは、絶対値設定部201のX軸の設定欄208に操作入力部Dのキーボードで「300」という数値を入力し、[Enter]キーを押下する。既に入力されている「400」の値は、「300」の入力前にマウスにより範囲選択しておくか、キーボードの削除キーで削除しておく。キーボードの[Enter]キーが押下れ、入力が確定すると、CPU33の計算部34の機能により位置姿勢演算を行う(姿勢計算手段)。 Subsequently, the user changes the contents of the X-axis setting column 208 of the absolute value setting section 201 from "400" to "300" as shown in FIG. 19(b). Here, a numerical value of "300" is entered in the X-axis setting field 208 of the absolute value setting unit 201 using the keyboard of the operation input unit D, and the [Enter] key is pressed. Before inputting "300", the value "400" which has already been input should be selected with the mouse or deleted with the delete key of the keyboard. When the [Enter] key on the keyboard is pressed and the input is confirmed, position and orientation calculation is performed by the function of the calculation unit 34 of the CPU 33 (attitude calculation means).

まず、図17のステップS21において、操作対象のノードがワーク103に関連した教示点か判断する(モデル判断処理)。この例で操作しているノードは教示点107であり、ロボット101に関連した教示点のため、ステップS22をバイパスしてステップS4に進む。 First, at step S21 in FIG. 17, it is determined whether the node to be operated is a teaching point related to the workpiece 103 (model determination processing). In this example, the node being operated is the teaching point 107, which is related to the robot 101, so step S22 is bypassed and the process proceeds to step S4.

ステップS4では、当該の教示点(107)について選択されている座標系がツール座標系105か否かを判断する(S4)。ここで選択されている座標系が図19(a)のようにツール座標系105の場合はステップS14に進み、実施例1で説明したツール座標系105の相対値計算を実行する(相対値計算処理)。この相対値計算結果では、オイラー角変換を行い、ツール座標系105のオフセットとなる相対値(X、Y、Z、α、β、γ)を計算する。 In step S4, it is determined whether or not the coordinate system selected for the teaching point (107) is the tool coordinate system 105 (S4). If the coordinate system selected here is the tool coordinate system 105 as shown in FIG. 19A, the process advances to step S14 to execute the relative value calculation of the tool coordinate system 105 described in the first embodiment (relative value calculation process). As a result of this relative value calculation, Euler angle transformation is performed, and relative values (X, Y, Z, α, β, γ) to be offsets of the tool coordinate system 105 are calculated.

続いてステップS5において、実施例1の図3で説明したのと同様にツール座標系105における位置姿勢演算を行う(関節値計算処理)。そして、計算結果に基づき、表示装置Cの表示画面Eの表示を更新する(表示手段)。 Subsequently, in step S5, position and orientation calculation in the tool coordinate system 105 is performed (joint value calculation processing) in the same manner as described with reference to FIG. 3 of the first embodiment. Then, based on the calculation result, the display on the display screen E of the display device C is updated (display means).

ここでは、まず、ステップS7において、オフセット教示点107の各関節値がハードウェアや仕様、規約などにより定まる制約内か判断する(制約判断処理)。ステップS7で制約内の場合、ステップS9に進み、CPU33は姿勢演算結果に基づき表示装置Cの表示画面Eを更新する(正常系表示処理)。 Here, first, in step S7, it is determined whether each joint value of the offset teaching point 107 is within the constraints determined by the hardware, specifications, conventions, etc. (constraint judgment processing). If the constraint is satisfied in step S7, the process proceeds to step S9, and the CPU 33 updates the display screen E of the display device C based on the posture calculation result (normal system display processing).

更新内容は、ツール座標系105方向のオフセットとなる相対値(X、Y、Z、α、β、γ)を相対値設定部202に、また、逆運動学計算によるロボット101の各軸の関節値の計算結果を仮想環境画面10に反映させて表示を更新する。 The contents of the update are the relative values (X, Y, Z, α, β, γ) that are the offsets in the direction of the tool coordinate system 105 to the relative value setting unit 202, and the joints of each axis of the robot 101 by inverse kinematics calculation. The calculation result of the value is reflected on the virtual environment screen 10 to update the display.

なお、ステップS7で制約外の場合は、ステップS8に進み、ロボット101の姿勢が取れない旨を表示すべく、前述の図8のエラー画面50を表示し(異常系表処理)、編集前の状態に戻る。 If the restriction is not met in step S7, the process proceeds to step S8 to display the error screen 50 shown in FIG. return to state.

図18(b)は、上記の編集後において、CPU33が仮想環境画面10に表示させるオフセット教示点107のロボット101の位置姿勢の更新の様子を示している。 FIG. 18B shows how the position and orientation of the robot 101 at the offset teaching point 107 displayed on the virtual environment screen 10 by the CPU 33 are updated after the above editing.

また、図19(c)は、編集後のオフセット教示点107のパラメータを示している。
図19(a)~(b)の操作では、絶対値設定部201でX座標値を「400」から「300」へ変更している。この時のツール座標系105方向のオフセットとなる相対値設定部202の表示は、上記の相対値計算に基づき、X座標値が「0」から「100」に変更されている。
FIG. 19(c) shows parameters of the offset teaching point 107 after editing.
19A and 19B, the absolute value setting unit 201 changes the X coordinate value from "400" to "300". At this time, the display of the relative value setting unit 202, which is the offset in the direction of the tool coordinate system 105, has the X coordinate value changed from "0" to "100" based on the above relative value calculation.

なお、図17のステップS16の編集終了時点におけるパラメータ設定画面20の確定ボタン209およびキャンセルボタン210の用法については、上述の実施例と同様である。 The use of the confirm button 209 and cancel button 210 on the parameter setting screen 20 at the end of editing in step S16 of FIG. 17 is the same as in the above-described embodiment.

以上のように、ベース座標系を選択したオフセット教示点107の絶対値のパラメータを変更した場合でも、作業者は絶対値編集作業と同時に位置姿勢と相対値のパラメータをすぐに確認できるようになり、確認に必要な工数の削減を図ることができる。即ち、実施例1と併せて考えれば、本システムでは、オフセット教示点107を編集する場合、相対値を用いても絶対値を用いてもオフセット教示点107の編集、およびそれに基づく表示画面Eの更新を適切に実行することができる。 As described above, even when the absolute value parameters of the offset teaching point 107 with the base coordinate system selected are changed, the operator can immediately check the position/orientation and relative value parameters while editing the absolute values. , the man-hours required for confirmation can be reduced. In other words, when the offset teaching point 107 is edited in this system in conjunction with the first embodiment, the offset teaching point 107 is edited using either the relative value or the absolute value, and the display screen E is displayed based on the editing. Updates can be performed properly.

(ベース座標系104が選択されたオフセット教示点107の絶対値編集)
次に、2つ目のケース、ベース座標系104が選択されたオフセット教示点107の絶対値編集について、図11、および図17、図18、図20を用いて説明する。以下では、制御手順については、上記と同じ図17を参照する。また、パラメータ設定画面20については、図20(a)~(c)の表示画面を用いる。
(Absolute value editing of offset teaching point 107 with base coordinate system 104 selected)
Next, the second case, the absolute value editing of the offset teaching point 107 with the base coordinate system 104 selected, will be described with reference to FIGS. 11, 17, 18 and 20. FIG. Below, the same FIG. 17 as above will be referred to for the control procedure. As for the parameter setting screen 20, the display screens shown in FIGS. 20(a) to 20(c) are used.

まず、管理画面40(図11(a))のオフセット教示点107を選択して、編集を開始する(S12)。この選択の手法は、前述同様、管理画面40上の教示点107(P100)のノードを操作入力部Dのマウスでクリックすることなどにより行う。 First, the offset teaching point 107 on the management screen 40 (FIG. 11(a)) is selected to start editing (S12). This selection method is performed by clicking the node of the teaching point 107 (P100) on the management screen 40 with the mouse of the operation input unit D, as described above.

本例で行う絶対値編集操作は、上記のツール座標系が選択されたオフセット教示点107の絶対値編集と同等のものである。従って、仮想環境画面10については、図18(a)、(b)の表示が本例でも通用する。 The absolute value editing operation performed in this example is equivalent to the absolute value editing of the offset teaching point 107 in which the tool coordinate system is selected. Therefore, as for the virtual environment screen 10, the displays shown in FIGS. 18A and 18B are also applicable to this example.

本例では、パラメータの数値設定では、表示装置Cの表示画面Eに図20(a)~(c)に示すようなパラメータ設定画面20を表示して用いる。 In this example, parameter setting screens 20 as shown in FIGS.

図17のステップS26において、ユーザはオフセット教示点107の絶対値を編集する(パラメータ設定手段)。図20(a)は、このとき、パラメータ設定画面20の絶対値設定部201の設定欄208へアクセスする操作を示している。即ち、図示のように、絶対値設定部201のX軸の設定欄208を操作入力部Dのマウスのカーソル205でクリックする。 At step S26 in FIG. 17, the user edits the absolute value of the offset teaching point 107 (parameter setting means). FIG. 20A shows an operation for accessing the setting column 208 of the absolute value setting section 201 of the parameter setting screen 20 at this time. That is, as shown in the figure, the X-axis setting field 208 of the absolute value setting section 201 is clicked with the mouse cursor 205 of the operation input section D. FIG.

なお、図20(a)の段階で、教示点名設定部212の表示は教示点107に相当する「P100」に切り替えられている。また、教示点設定部203の値は、基準となる教示点106に対応する「P001」に切り替えられている。また、座標系選択部204の表示の通り、座標系としてはベース座標系が選択されている。 20A, the display of the teaching point name setting section 212 has been switched to "P100" corresponding to the teaching point 107. As shown in FIG. Also, the value of the taught point setting unit 203 is switched to "P001" corresponding to the taught point 106 that serves as the reference. Further, as displayed in the coordinate system selection section 204, the base coordinate system is selected as the coordinate system.

続いて、ユーザは図20(b)に示すように絶対値設定部201のX座標値の設定欄208の内容を「400」から「300」に変更する。ここでは、絶対値設定部201のX軸の設定欄208に操作入力部Dのキーボードで「300」という数値を入力し、[Enter]キーを押下する。既に入力されている「400」の値は、「300」の入力前にマウスにより範囲選択しておくか、キーボードの削除キーで削除しておく。キーボードの[Enter]キーが押下れ、入力が確定すると、CPU33の計算部34の機能により位置姿勢演算を行う(姿勢計算手段)。 Subsequently, the user changes the contents of the X coordinate value setting column 208 of the absolute value setting section 201 from "400" to "300" as shown in FIG. 20(b). Here, a numerical value of "300" is entered in the X-axis setting field 208 of the absolute value setting unit 201 using the keyboard of the operation input unit D, and the [Enter] key is pressed. Before inputting "300", the value "400" which has already been input should be selected with the mouse or deleted with the delete key of the keyboard. When the [Enter] key on the keyboard is pressed and the input is confirmed, position and orientation calculation is performed by the function of the calculation unit 34 of the CPU 33 (attitude calculation means).

まず、図17のステップS21において、操作対象のノードがワーク103に関連した教示点か判断する(モデル判断処理)。この例で操作しているノードは教示点107であり、ロボット101に関連した教示点のため、ステップS22をバイパスしてステップS4に進む。 First, at step S21 in FIG. 17, it is determined whether the node to be operated is a teaching point related to the workpiece 103 (model determination processing). In this example, the node being operated is the teaching point 107, which is related to the robot 101, so step S22 is bypassed and the process proceeds to step S4.

ステップS4では、当該の教示点(107)について選択されている座標系がツール座標系105か否かを判断する(S4)。ここで選択されている座標系が図20(a)のようにベース座標系104の場合はステップS15に進み、実施例1で説明したベース座標系104の相対値計算を実行する(相対値計算処理)。この相対値計算結果では、オイラー角変換を行い、ベース座標系104におけるオフセットとなる相対値(X、Y、Z、α、β、γ)を計算する。 In step S4, it is determined whether or not the coordinate system selected for the teaching point (107) is the tool coordinate system 105 (S4). If the coordinate system selected here is the base coordinate system 104 as shown in FIG. 20A, the process advances to step S15 to execute the relative value calculation of the base coordinate system 104 described in the first embodiment (relative value calculation process). As a result of this relative value calculation, Euler angle transformation is performed, and relative values (X, Y, Z, α, β, γ) to be offsets in the base coordinate system 104 are calculated.

続いてステップS6において、実施例1の図3で説明したのと同様にベース座標系104における位置姿勢演算を行う(関節値計算処理)。そして、計算結果に基づき、表示装置Cの表示画面Eの表示を更新する(表示手段)。なお、ステップS4でツール座標系が選択されている場合には、前述同様にステップS14でツール座標系の相対値計算を行い、それに基づきステップS5でツール座標系の姿勢計算が行われる。 Subsequently, in step S6, position and orientation calculation in the base coordinate system 104 is performed (joint value calculation processing) in the same manner as described with reference to FIG. 3 of the first embodiment. Then, based on the calculation result, the display on the display screen E of the display device C is updated (display means). If the tool coordinate system is selected in step S4, the relative values of the tool coordinate system are calculated in step S14 in the same manner as described above, and the attitude of the tool coordinate system is calculated in step S5.

続いて、ステップS7において、オフセット教示点107の各関節値がハードウェアや仕様、規約などにより定まる制約内か判断する(制約判断処理)。ステップS7で制約内の場合、ステップS9に進み、CPU33は姿勢演算結果に基づき表示装置Cの表示画面Eを更新する(正常系表示処理)。 Subsequently, in step S7, it is determined whether each joint value of the offset teaching point 107 is within the constraints determined by the hardware, specifications, regulations, etc. (restriction determination processing). If the constraint is satisfied in step S7, the process proceeds to step S9, and the CPU 33 updates the display screen E of the display device C based on the posture calculation result (normal system display processing).

更新内容は、ベース座標系104方向のオフセットとなる(X、Y、Z、α、β、γ)を相対値設定部202に、また、逆運動学計算によるロボット101の各軸の関節値の計算結果を仮想環境画面10に反映させて表示を更新する。 The updated contents are the offsets (X, Y, Z, α, β, γ) in the direction of the base coordinate system 104 to the relative value setting unit 202, and the joint values of each axis of the robot 101 by inverse kinematics calculation. The calculation result is reflected on the virtual environment screen 10 to update the display.

なお、ステップS7で制約外の場合は、ステップS8に進み、ロボット101の姿勢が取れない旨を表示すべく、前述の図8のエラー画面50を表示し(異常系表処理)、編集前の状態に戻る。 If the restriction is not met in step S7, the process proceeds to step S8 to display the error screen 50 shown in FIG. return to state.

図18(b)は、上記の編集後において、CPU33が仮想環境画面10に表示させるオフセット教示点107のロボット101の位置姿勢の更新の様子を示している。 FIG. 18B shows how the position and orientation of the robot 101 at the offset teaching point 107 displayed on the virtual environment screen 10 by the CPU 33 are updated after the above editing.

また、図20(c)は、編集後のオフセット教示点107のパラメータを示している。
図20(a)~(b)の操作では、絶対値設定部201でX座標値を「400」から「300」へ変更している。この時のベース座標系104方向のオフセットとなる相対値設定部202の表示は、上記の相対値計算に基づき、X座標値が「0」から「-100」に変更されている。ここで、先のツール座標系が選択されたオフセット教示点107の絶対値編集の場合と異なり、相対値設定部202のX座標値が負値となっている。これは、例えば図18(a)、(b)のようなロボット101の姿勢ではベース座標系104とツール座標系105がZ軸の正方向が正対するような姿勢となっていることによる。
FIG. 20(c) shows parameters of the offset teaching point 107 after editing.
20A and 20B, the absolute value setting unit 201 changes the X coordinate value from "400" to "300". The display of the relative value setting unit 202, which is the offset in the direction of the base coordinate system 104 at this time, has the X coordinate value changed from "0" to "-100" based on the above relative value calculation. Here, unlike the case of absolute value editing of the offset teaching point 107 in which the tool coordinate system is selected, the X coordinate value of the relative value setting unit 202 is a negative value. This is because the base coordinate system 104 and the tool coordinate system 105 are oriented such that the positive directions of the Z-axis face each other in the postures of the robot 101 shown in FIGS. 18A and 18B.

なお、図17のステップS16の編集終了時点におけるパラメータ設定画面20の確定ボタン209およびキャンセルボタン210の用法については、上述の実施例と同様である。 The use of the confirm button 209 and cancel button 210 on the parameter setting screen 20 at the end of editing in step S16 of FIG. 17 is the same as in the above-described embodiment.

以上のように、ベース座標系を選択したオフセット教示点107の絶対値のパラメータを変更した場合でも、作業者は絶対値編集作業と同時に位置姿勢と相対値のパラメータをすぐに確認できるようになり、確認に必要な工数の削減を図ることができる。先の例と併せて考えれば、本システムでは、オフセット教示点107を編集する場合、その表現がツール座標系でもベース座標系でもオフセット教示点107の同等の操作で極めて容易に教示データを編集できる。そして、編集操作に基づき、直ちに編集内容に基づき、表示画面Eの更新を適切に実行することができる。 As described above, even when the absolute value parameters of the offset teaching point 107 with the base coordinate system selected are changed, the operator can immediately check the position/orientation and relative value parameters while editing the absolute values. , the man-hours required for confirmation can be reduced. In view of the previous example, in this system, when editing the offset teaching point 107, the teaching data can be edited extremely easily by the equivalent operation of the offset teaching point 107 regardless of whether the representation is in the tool coordinate system or the base coordinate system. . Then, based on the editing operation, the display screen E can be updated appropriately immediately based on the editing content.

(ワーク103に関連したオフセット教示点110の絶対値編集)
次に、絶対値編集に関する最後のケース、ワーク103に関連したオフセット教示点110の絶対値編集について説明する。オフセット教示点110の絶対値編集は、上記のオフセット教示点107の絶対値編集の場合と基本的には同等であるため、上記の2つの絶対値編集の場合と異なる部分を中心に説明する。
(Absolute value editing of offset teaching point 110 related to work 103)
Next, the last case regarding absolute value editing, absolute value editing of the offset teaching point 110 related to the workpiece 103 will be described. Since the absolute value editing of the offset teaching point 110 is basically the same as the absolute value editing of the offset teaching point 107, the differences from the above two absolute value editing will be mainly described.

ワーク103に関連したオフセット教示点110の絶対値編集の制御については図17の制御手順を用いることができる。管理画面40については、例えば図11(a)の表示が該当する。また、通常、ワーク103に関連したオフセット教示点110に関してはベース座標系の値が用いられる。このため、パラメータの数値入力については、ベース座標系の絶対値編集で参照した図20(a)~(c)に示したものと同等の設定画面20の表示を用いることができる。 The control procedure of FIG. 17 can be used for controlling the absolute value editing of the offset teaching point 110 related to the work 103 . For the management screen 40, for example, the display of FIG. 11(a) corresponds. Also, normally, the values of the base coordinate system are used for the offset teaching point 110 related to the workpiece 103 . Therefore, for numerical input of parameters, the display of the setting screen 20 equivalent to that shown in FIGS.

まず、管理画面40(図11(a))のオフセット教示点110を選択して、編集を開始する(図17のステップS12)点は上述の例と同様である。これにより、パラメータ設定画面20(例えば図20(a))の教示点名設定部212の表示は、教示点110に相当する「P110」に切り替えられている。また、教示点設定部203の値は、基準となる教示点109に対応する「P010」に切り替えられることになる。また、ワーク103以下のノードでは、座標系としてはベース座標系が選択されているものとする。 First, the offset teaching point 110 on the management screen 40 (FIG. 11(a)) is selected and editing is started (step S12 in FIG. 17), as in the above example. As a result, the display of the teaching point name setting section 212 of the parameter setting screen 20 (for example, FIG. 20(a)) is switched to "P110" corresponding to the teaching point 110. FIG. Also, the value of the taught point setting unit 203 is switched to "P010" corresponding to the taught point 109 serving as the reference. It is also assumed that the base coordinate system is selected as the coordinate system for the nodes below the workpiece 103 .

ここで、例えば基準となる教示点109およびオフセット教示点110が、前述の実施例の基準となるロボット側のノードの教示点106およびオフセット教示点107と同等であるものとする。その場合には、絶対値設定部201の数値の並びは図20(a)(~(c))のものがそのまま通用する。 Here, for example, the reference teaching point 109 and the offset teaching point 110 are assumed to be equivalent to the reference teaching point 106 and the offset teaching point 107 of the node on the robot side in the above-described embodiment. In that case, the sequence of numerical values in the absolute value setting section 201 shown in FIGS.

図17のステップS26においては、上述のオフセット教示点107の絶対値編集で説明したのと同様の操作によりユーザがパラメータ設定画面20のオフセット教示点110の絶対値を編集する(パラメータ設定手段)。ここで、ユーザの操作も、上述の例と同様の絶対値設定部201のX座標値の設定欄208の内容を「400」から「300」に変更する内容であるものとする。操作入力部Dのキーボードでこの絶対値設定部201のX座標値の変更操作を行い、キーボードの[Enter]キーを押下すると、CPU33の計算部34の機能により位置姿勢演算を行う(姿勢計算手段)。 In step S26 of FIG. 17, the user edits the absolute value of the offset teaching point 110 on the parameter setting screen 20 (parameter setting means) by the same operation as described in the editing of the absolute value of the offset teaching point 107 above. Here, it is assumed that the user's operation is to change the content of the X coordinate value setting column 208 of the absolute value setting unit 201 from "400" to "300" as in the above example. When the keyboard of the operation input unit D is used to change the X coordinate value of the absolute value setting unit 201 and the [Enter] key of the keyboard is pressed, position and orientation calculation is performed by the function of the calculation unit 34 of the CPU 33 (attitude calculation means ).

続いて、図17のステップS21において、当該のオフセット教示点110がワーク103に関連した教示点か判断する(モデル判断処理)。本例では、オフセット教示点110の上位の基準となる教示点109は、ワーク103に関連した教示点であるからステップS22に進む。ステップS22では、ロボット101のベース座標系104からの相対値を計算する(ベース座標系の相対値計算)。 Subsequently, in step S21 of FIG. 17, it is determined whether the offset teaching point 110 is a teaching point related to the workpiece 103 (model determination processing). In this example, the taught point 109, which is the upper reference of the offset taught point 110, is a taught point related to the workpiece 103, so the process proceeds to step S22. In step S22, the relative value of the robot 101 from the base coordinate system 104 is calculated (relative value calculation of the base coordinate system).

ステップS22のベース座標系の相対値計算移行の制御は、前述のオフセット教示点107に関する絶対値編集の例と同様に進む。 Control of transition to relative value calculation of the base coordinate system in step S22 proceeds in the same manner as the example of absolute value editing regarding the offset teaching point 107 described above.

以上のように、本システムによれば、ワーク103に関連したオフセット教示点110の絶対値のパラメータの変更もロボット101のノードツリーにあるオフセット教示点107の場合と同様に行える。この場合も、作業者は絶対値編集作業と同時に位置姿勢と相対値のパラメータをすぐに確認でき、確認に必要な工数の削減を図ることができる。 As described above, according to this system, the parameter of the absolute value of the offset teaching point 110 related to the workpiece 103 can be changed in the same manner as the offset teaching point 107 in the node tree of the robot 101 . In this case also, the operator can immediately check the position/orientation and relative value parameters at the same time as the absolute value editing work, thereby reducing the man-hours required for checking.

先の例と併せて考えれば、本システムでは、ワーク103のノードツリーにあるオフセット教示点110の場合でも、ロボット101のノードツリーにあるオフセット教示点107の場合でも、同等の操作で極めて容易に教示データを編集できる。そして、編集操作に基づき、直ちに編集内容に基づき、表示画面Eの更新を適切に実行することができる。 Considering this together with the previous example, in this system, the offset teaching point 110 in the node tree of the workpiece 103 and the offset teaching point 107 in the node tree of the robot 101 can be handled very easily with the same operation. Teaching data can be edited. Then, based on the editing operation, the display screen E can be updated appropriately immediately based on the editing content.

以下、本発明の実施例4に係る情報処理装置および情報処理方法について、図21、図22を参照して説明する。 An information processing apparatus and an information processing method according to a fourth embodiment of the present invention will be described below with reference to FIGS. 21 and 22. FIG.

実施例1から実施例3では、ロボット制御データ(教示データ)としての教示点の位置姿勢データの編集をパラメータ設定画面20での相対値や絶対値の数値入力により行う操作方式を示した。 Embodiments 1 to 3 show an operation method in which position and orientation data of teaching points as robot control data (teaching data) are edited by numerically inputting relative values and absolute values on the parameter setting screen 20 .

位置姿勢データの入力ないし編集に係るその他の操作方式としては、操作入力部D(ないし仮想環境画面10)に関連して、仮想環境画面10に表示されているロボット101の位置姿勢を変更するGUI操作手段を設ける構成が考えられる。その場合、操作入力部Dの操作手段によって行われたロボット装置の位置姿勢の変更に応じて、仮想環境画面10のロボット101の仮想表示を更新し、また、パラメータ設定画面20の数値表示の内容を更新することができる。 As another operation method for inputting or editing position/orientation data, a GUI for changing the position/orientation of the robot 101 displayed on the virtual environment screen 10 in relation to the operation input unit D (or the virtual environment screen 10) is used. A configuration in which an operation means is provided is conceivable. In this case, the virtual display of the robot 101 on the virtual environment screen 10 is updated in accordance with the change in the position and orientation of the robot apparatus performed by the operation means of the operation input unit D, and the contents of the numerical display on the parameter setting screen 20 are updated. can be updated.

このような操作手段としては、図22(a)、(b)に示すように、仮想環境画面10に、操作入力部Dのポインティングデバイス(例えばマウス)のカーソル205で操作可能な操作ハンドル111を表示させるGUI構成が考えられる。 As such an operation means, as shown in FIGS. 22A and 22B, an operation handle 111 that can be operated with a cursor 205 of a pointing device (for example, a mouse) of the operation input unit D is provided on the virtual environment screen 10. A GUI configuration to be displayed is conceivable.

以下、情報処理装置Aにおいて、上記のような操作ハンドル111を用いた位置姿勢データの入力ないし編集を行う構成および制御につき、図21、図22(a)、(b)、図25、および実施例2の図11を用いて説明する。なお、以下では、操作ハンドル111でロボット101の仮想表示を操作することにより、オフセット教示点107を編集する場合につき説明するが、他の教示点、例えばオフセット教示点110の場合も同様の処理で行うことができる。 21, 22(a), 22(b), 25, and the implementation of the configuration and control for inputting or editing the position and orientation data using the operation handle 111 as described above in the information processing apparatus A will be described below. This will be described with reference to FIG. 11 of Example 2. FIG. In the following description, editing the offset teaching point 107 by operating the virtual display of the robot 101 with the operating handle 111 will be described. It can be carried out.

図21は、操作ハンドル111による操作ハンドル111を用いて教示点の入力ないし編集を行う場合の制御手順を示している。 FIG. 21 shows a control procedure when the operation handle 111 is used to input or edit teaching points.

本実施例では、操作ハンドル111でロボット101の仮想表示を操作することにより、オフセット教示点107を編集する。そのため、ユーザは、まず図21のステップS12において、管理画面40(図11(a))のオフセット教示点107を選択して、編集開始を指定する。この時の操作方式としては、上述同様に操作入力部Dのマウスのカーソル(ポインタ)で管理画面40(図11(a))のオフセット教示点107をクリックする方式を用いることができる。 In this embodiment, the offset teaching point 107 is edited by operating the virtual display of the robot 101 with the operating handle 111 . Therefore, in step S12 of FIG. 21, the user first selects the offset teaching point 107 on the management screen 40 (FIG. 11(a)) to designate the start of editing. As an operation method at this time, a method of clicking the offset teaching point 107 on the management screen 40 (FIG. 11(a)) with the cursor (pointer) of the mouse of the operation input unit D can be used as described above.

続いて、ユーザはステップS27において、操作入力部Dのマウスのカーソル(ポインタ)で操作ハンドル111を操作し、ロボット101の位置姿勢を変更する。操作ハンドル111は、例えば図22(a)に示すようにロボット101の先端の部位に重畳表示する。操作ハンドル111は、例えば図示のようにロボット101先端のツール102の上にワイヤフレーム表示された表示オブジェクトとすることができる。 Subsequently, in step S27, the user operates the operation handle 111 with the mouse cursor (pointer) of the operation input unit D to change the position and orientation of the robot 101. FIG. The operating handle 111 is superimposed on the tip of the robot 101 as shown in FIG. 22(a), for example. The operating handle 111 can be, for example, a display object displayed as a wire frame above the tool 102 at the tip of the robot 101 as shown.

この操作ハンドル111の表示オブジェクトは、例えば操作ハンドル111は、現在設定しているオフセット教示点107の座標系方向を表示するよう図形的に構成されたリング状のオブジェクトとすることができる。 The display object of the operating handle 111 can be, for example, a ring-shaped object that is graphically configured to display the coordinate system direction of the currently set offset teaching point 107 .

また、操作ハンドル111は、例えば操作入力部Dのマウスのカーソル(ポインタ)でほぼ直線的に画面上でクリック、ドラッグできるよう構成することもできる。このクリック、ドラッグ操作の場合は、例えばロボット101の先端のツール102の配置されるフランジ面中心などに設定された基準部位を仮想環境画面10中の3D空間中の任意の位置に移動させる。 Further, the operation handle 111 can be configured so that the cursor (pointer) of the mouse of the operation input unit D can be clicked and dragged on the screen substantially linearly, for example. In the case of this click and drag operation, for example, the reference portion set at the center of the flange surface on which the tool 102 at the tip of the robot 101 is arranged is moved to any position in the 3D space in the virtual environment screen 10 .

また、この操作ハンドル111による移動操作により、本実施例のようにオフセット教示点107を操作する場合は、例えばロボット101の基準部位がオフセット教示点107と関係づけられる。この場合には、オフセット教示点107を操作すると、オフセット教示点107と関係づけられたロボット101の基準部位が移動し、これに同期してロボット101の位置姿勢が変化するよう、CPU33による制御を行う。 Further, when the offset teaching point 107 is operated by the operation handle 111 as in the present embodiment, the reference portion of the robot 101 is associated with the offset teaching point 107, for example. In this case, when the offset teaching point 107 is operated, the reference portion of the robot 101 associated with the offset teaching point 107 moves, and the CPU 33 controls the position and orientation of the robot 101 to change in synchronism with this movement. conduct.

なお、本実施例のように操作ハンドル111によりオフセット教示点(107)を操作する場合には、操作ハンドル111で指定する移動(量)を絶対値ないし相対値のいずれかに対応づけられていると便利である。ここで「相対値」は例えばツール座標系105のような相対座標系における座標値(位置姿勢データ)である。また、「絶対値」は例えばベース座標系104のような絶対座標系における座標値(位置姿勢データ)である。 When the offset teaching point (107) is operated by the operating handle 111 as in this embodiment, the movement (amount) designated by the operating handle 111 is associated with either an absolute value or a relative value. and convenient. Here, the "relative value" is a coordinate value (position/orientation data) in a relative coordinate system such as the tool coordinate system 105, for example. Also, the “absolute value” is a coordinate value (position/orientation data) in an absolute coordinate system such as the base coordinate system 104 .

例えば、図21の手順を開始した時に選択した教示点に既に相対値(または絶対値)が割り当てられていれば、操作ハンドル111で指定する移動量を相対値(または絶対値)によって取り扱う。また、操作入力部Dの特定操作によって、操作ハンドル111の操作により入力する移動量が相対値(または絶対値)であるかを指定できるようにしておいてもよい。 For example, if a relative value (or absolute value) has already been assigned to the selected teaching point when the procedure of FIG. Further, it may be possible to specify whether the amount of movement input by operating the operation handle 111 is a relative value (or an absolute value) by a specific operation of the operation input unit D. FIG.

以下では、便宜上、以上のようにして相対値を入力する状態に制御されている操作ハンドル111を「相対値ハンドル」、絶対値を入力する状態に制御されている操作ハンドル111を「絶対値ハンドル」という。 Hereinafter, for the sake of convenience, the operation handle 111 controlled to input a relative value as described above will be referred to as a "relative value handle", and the operation handle 111 controlled to input an absolute value as described above will be referred to as an "absolute value handle". ”.

そして上記の操作ハンドル111による移動操作が行なわれると、CPU33はオフセット教示点107(基準部位)の移動先の位置に応じてロボット101の各関節の角度を変更する位置姿勢演算を行う。CPU33はこの位置姿勢演算の結果に応じて仮想環境画面10に表示するロボット101の位置姿勢を変化させる。なお、以上のような操作ハンドル111を用いたGUIの細部は周知の技術であるから、ここでは上記以上の詳細な説明は省略する。 Then, when a movement operation is performed by the operation handle 111, the CPU 33 performs position/orientation calculation for changing the angle of each joint of the robot 101 in accordance with the position of the movement destination of the offset teaching point 107 (reference portion). The CPU 33 changes the position and orientation of the robot 101 displayed on the virtual environment screen 10 according to the result of this position and orientation calculation. Since the details of the GUI using the operation handle 111 as described above are well-known techniques, detailed description above will be omitted here.

図22(a)~(b)では、操作ハンドル111を右方にクリック、ドラッグしている。そして、図22(a)では実線、図22(b)では破線で示した位置姿勢から、図22(b)に実線で示した位置姿勢にロボット101の位置姿勢を変化させる様子を示してある。マウスのドラッグ操作期間中では、連続的な移動を指定し、移動終了は、マウスのボタンをリリースして指定する。 In FIGS. 22A and 22B, the operating handle 111 is clicked and dragged to the right. FIG. 22(a) shows how the robot 101 changes its position and orientation from the solid line in FIG. 22(a) and the broken line in FIG. 22(b) to the solid line in FIG. 22(b). . During the mouse drag operation, continuous movement is specified, and the end of the movement is specified by releasing the mouse button.

なお、操作ハンドル111は仮想環境画面10中に常時表示してもよいし、また、(例えば仮想環境操作モード、3D操作モードのような操作モードを指定する)操作入力部Dの設定操作に応じて必要なタイミングでのみ表示するようにしてもよい。 Note that the operating handle 111 may be always displayed in the virtual environment screen 10, or may be displayed according to the setting operation of the operation input unit D (for example, specifying an operation mode such as a virtual environment operation mode or a 3D operation mode). may be displayed only at necessary timing.

ステップS27において、ユーザは以上のようにして操作ハンドル111を用いて仮想環境画面10中に表示されたロボット101の位置姿勢を変化させることができる。この時、操作ハンドル111を用いた移動操作に応じて、CPU33は移動操作に応じた位置姿勢演算を行い、その演算結果に応じてロボット101の位置姿勢を変化させる。 In step S27, the user can change the position and orientation of the robot 101 displayed in the virtual environment screen 10 using the operating handle 111 as described above. At this time, the CPU 33 performs position/orientation calculation according to the movement operation according to the movement operation using the operation handle 111, and changes the position/orientation of the robot 101 according to the calculation result.

なお、この位置姿勢演算結果に応じてロボット101の位置姿勢を変化させるため画面更新は、例えば操作ハンドル111の微少操作ごとに行う方式が考えられる。あるいは、移動操作中はマウスのカーソル(ポインタ)と、さらに操作ハンドル111など小さな画面範囲で表示可能な部分のみを移動させ、マウスのリリース操作に応じてロボット101全体の位置姿勢を描画するような方式を用いてもよい。 In order to change the position and orientation of the robot 101 according to the position and orientation calculation results, a method of updating the screen for each minute operation of the operating handle 111, for example, is conceivable. Alternatively, during the movement operation, only the mouse cursor (pointer) and the operation handle 111, which can be displayed in a small screen area, are moved, and the position and orientation of the entire robot 101 are drawn according to the mouse release operation. method may be used.

ステップS27において、CPU33は、移動操作~位置姿勢演算(姿勢計算手段)~仮想環境画面10の描画の更新を少なくとも上記の操作ハンドル111の微少操作に応じた部分について行う。 In step S27, the CPU 33 performs the movement operation, the position and orientation calculation (orientation calculation means), and the drawing update of the virtual environment screen 10 for at least the part corresponding to the minute operation of the operation handle 111 described above.

なお、図21の制御手順は、理解を容易にするために前述の図17と同等の様式で記載されている。このため、図21は上記のマウスのリリース操作に応じてロボット101全体の位置姿勢を描画するような方式に該当するようなステップ配置になっている。しかし、例えばCPU33廻りの制御系が充分な処理能力を有している場合には、ステップS27の操作ハンドル111の微少操作毎に、ステップS28から同図最後のS9までの処理を繰り返し実行するようにソフトウェアを構成することができる。 It should be noted that the control procedure of FIG. 21 is described in a manner similar to that of FIG. 17 described above for easy understanding. For this reason, FIG. 21 has a step arrangement that corresponds to the method of drawing the position and orientation of the entire robot 101 according to the mouse release operation. However, if, for example, the control system around the CPU 33 has sufficient processing power, the processing from step S28 to S9 at the end of the figure may be repeatedly executed for each minute operation of the operating handle 111 in step S27. You can configure the software to

ステップS28では、CPU33は、現在の操作ハンドル111が相対値ハンドルか(絶対値ハンドル)を判断する。ステップS28において操作ハンドル111がツール座標系105方向のベクトルを表示している、即ち、相対値ハンドルの場合には、ステップS29に進む。ステップS29では、CPU33は基準となる教示点106からオフセット教示点107までの相対値に、マウスで選択したベクトル方向の移動量を加算して移動後の相対値として計算を行う。 In step S28, the CPU 33 determines whether the current operating handle 111 is a relative value handle (absolute value handle). In step S28, if the operating handle 111 displays a vector in the direction of the tool coordinate system 105, that is, if it is a relative value handle, the process proceeds to step S29. In step S29, the CPU 33 adds the amount of movement in the direction of the vector selected with the mouse to the relative value from the reference taught point 106 to the offset taught point 107, and calculates the relative value after the movement.

一方、ステップS28において操作ハンドル111が絶対座標系(例えばベース座標系104)方向の絶対値ハンドルを表示している場合は、ステップS30に進む。ステップS30では、CPU33は絶対座標系からオフセット教示点107までの絶対値に、マウスで選択したベクトル方向の移動量を加算して移動後の絶対値として計算を行う。 On the other hand, if the operation handle 111 displays an absolute value handle in the direction of the absolute coordinate system (for example, the base coordinate system 104) in step S28, the process proceeds to step S30. In step S30, the CPU 33 adds the amount of movement in the direction of the vector selected with the mouse to the absolute value from the absolute coordinate system to the offset teaching point 107, and calculates the absolute value after the movement.

以上のようにして、移動後のオフセット教示点107の値(相対値または絶対値)が入力される。ステップS29またはS30に続いて、ステップS21では、当該の教示点がワークに関連づけられた教示点か否かを判断する。そして、ステップS21が肯定された場合にはステップS22でロボットのベース座標系への相対値変換を行う計算を実行する。図21において、続くステップS4以降の処理は、上述の図17のステップS4以降の処理と同じである。ステップS4以降では、当該の教示点の表現がツール座標系(ベース座標系)かに応じて、ロボット101の位置姿勢演算を行う(ステップS14、S5、ステップS15、S6)。続いてハードウェアや仕様、規約などにより定まる制約内か判断し、必要に応じてエラー処理を行う(ステップS7、S8)。 As described above, the value (relative value or absolute value) of the offset teaching point 107 after movement is input. Following step S29 or S30, in step S21, it is determined whether or not the teaching point is a teaching point associated with a work. Then, when step S21 is affirmative, in step S22, a calculation for performing relative value conversion to the base coordinate system of the robot is executed. In FIG. 21, the processing after step S4 is the same as the processing after step S4 in FIG. 17 described above. After step S4, the position and orientation of the robot 101 are calculated depending on whether the teaching point is expressed in the tool coordinate system (base coordinate system) (steps S14, S5, steps S15, S6). Subsequently, it is determined whether or not it is within the constraints determined by the hardware, specifications, rules, etc., and error processing is performed as necessary (steps S7 and S8).

そして、制約エラーがなければ、計算結果に応じて(最終的な)表示装置Cの表示画面Eの更新を行う。即ち、操作ハンドル111によって行われたロボット101の位置姿勢の変更に応じて、仮想環境画面10のロボット101の仮想表示を(最終的に)更新し、また、パラメータ設定画面20の数値表示の内容を更新する。図22(b)の実線で示したロボット101の位置姿勢は、は、ロボット101の先端に表示された操作ハンドル111でオフセット教示点107を移動した編集後のロボット101の位置姿勢に対応する。また、もちろん、パラメータ設定画面20の数値表示の内容は、前述(例えば図5や図6)同様に、オフセット教示点107の(操作ハンドル111による)編集操作に応じて更新される(ステップS9)。以上のようにして図21のオフセット教示点の編集処理は終了する(ステップS16)。 Then, if there is no constraint error, the (final) display screen E of the display device C is updated according to the calculation result. That is, the virtual display of the robot 101 on the virtual environment screen 10 is (finally) updated according to the change in the position and orientation of the robot 101 performed by the operation handle 111, and the contents of the numerical display on the parameter setting screen 20 are updated. to update. The position and orientation of the robot 101 indicated by solid lines in FIG. Further, of course, the contents of the numerical display on the parameter setting screen 20 are updated according to the editing operation (using the operation handle 111) of the offset teaching point 107 (step S9), as described above (for example, FIGS. 5 and 6). . Thus, the offset teaching point editing process of FIG. 21 ends (step S16).

以上のように、本実施例によれば、位置姿勢データの入力ないし編集に係るその他の操作方式としては、操作入力部D(ないし仮想環境画面10)に関連して、仮想表示されたロボット101の位置姿勢を変更するGUI操作手段を設けている。そして、ユーザは、操作ハンドル111を用いた仮想環境画面10上の極めて直感的な操作により、ロボット101(ないしそれに関連づけされた教示点)の位置(姿勢)を変更する入力、編集操作を行うことができる。そして、この仮想環境画面10における入力、編集操作の結果は、同期的に仮想環境画面10のロボット101の仮想表示に反映され、また、パラメータ設定画面20の数値表示の内容に反映される。従って、ユーザ(作業者)は、例えば操作ハンドル111を操作すると同時に位置姿勢とパラメータをすぐに確認でき、確認に必要な工数の削減を図ることができる。 As described above, according to the present embodiment, as another operation method for inputting or editing position/orientation data, the robot 101 that is virtually displayed in relation to the operation input unit D (or the virtual environment screen 10) is displayed. A GUI operation means for changing the position and orientation of is provided. Then, the user can perform input and editing operations to change the position (orientation) of the robot 101 (or teaching points associated with it) by very intuitive operations on the virtual environment screen 10 using the operation handle 111. can be done. The results of the input and editing operations on the virtual environment screen 10 are synchronously reflected in the virtual display of the robot 101 on the virtual environment screen 10 and reflected in the contents of the numerical values displayed on the parameter setting screen 20 . Therefore, the user (operator) can immediately check the position and orientation and parameters at the same time as operating the operating handle 111, for example, and can reduce the number of man-hours required for checking.

上述の実施例1~実施例4では、位置姿勢データが例えば作業空間に対応する特定の座標系における3次元座標(あるいはさらに軸廻りの角度)によって表現されている場合、その相対値や絶対値で表現されている内容を変更する入力、編集処理を説明した。 In Embodiments 1 to 4 described above, if the position and orientation data are represented by, for example, three-dimensional coordinates (or angles around the axis) in a specific coordinate system corresponding to the working space, their relative values and absolute values I explained the input and editing process to change the contents expressed in .

しかしながら、位置姿勢データの編集は、上記のような位置姿勢データ(3次元座標ないし軸廻りの角度)の相対値と絶対値を介してではなく、ロボット101の関節空間における関節値を直接変更するようなインターフェースを介して行いたい場合がある。 However, editing the position and orientation data directly changes the joint values in the joint space of the robot 101, not through the relative and absolute values of the position and orientation data (three-dimensional coordinates or angles around the axis) as described above. You may want to do this via an interface like

例えば、ユーザ(作業者)にとっては、ロボット101が特定の姿勢となっている状態から、例えば障害物回避などの目的でその姿勢から特定の1(ないし複数の)関節を回動させる動作が直感的かつ容易に理解できる場合がある。 For example, for a user (operator), it is intuitive that the robot 101 is in a specific posture, and the action of rotating a specific joint (or a plurality of joints) from that posture for the purpose of avoiding an obstacle, for example. can be intuitive and easy to understand.

この場合には、以下に示すように、例えば図25(a)~(c)に示すようにパラメータ設定画面20中に関節値(例えば回転角度)を変更できるような数値設定部として関節値設定部211を配置して、所望の関節の関節値を変更できるようにする。このような関節値設定部211を用いて関節値の数値設定を行った場合にも、上述同様にして関節値の編集結果に応じてロボット101の位置姿勢演算を行うことができ、その結果に対して上述のような制約エラーの有無を判定できる。また、関節値の編集結果に応じて、他のパラメータ設定画面20中の表示を更新し、仮想環境画面10中のロボット101の仮想表示を更新することができる。 In this case, as shown below, for example, as shown in FIGS. Section 211 is arranged to allow the joint value of the desired joint to be changed. Even when joint values are numerically set using such a joint value setting unit 211, the position and orientation of the robot 101 can be calculated according to the result of editing the joint values in the same manner as described above. On the other hand, it is possible to determine whether or not there is a constraint error as described above. In addition, the display in the other parameter setting screen 20 can be updated and the virtual display of the robot 101 in the virtual environment screen 10 can be updated according to the editing result of the joint values.

以下、パラメータ設定画面20中に用意した関節値設定部211を用いてオフセット教示点107の入力、編集を行う場合の制御につき、図11、および図23~図25を用いて説明する。なお、以下では、オフセット教示点107を編集する場合につき説明するが、他の教示点、例えばオフセット教示点110の場合も同様の処理で行うことができる。 The control for inputting and editing the offset teaching point 107 using the joint value setting section 211 provided in the parameter setting screen 20 will be described below with reference to FIGS. 11 and 23 to 25. FIG. In the following, a case of editing the offset teaching point 107 will be described, but other teaching points such as the offset teaching point 110 can be edited in the same way.

図23は、関節値編集を介して教示点の入力、編集を行う場合の制御手順を示している。 FIG. 23 shows a control procedure for inputting and editing taught points through joint value editing.

ユーザは、まず図23のステップS12において、管理画面40(図11(a))のオフセット教示点107を選択して、編集開始を指定する。この時の操作方式としては、上述同様に操作入力部Dのマウスのカーソル(ポインタ)で管理画面40(図11(a))のオフセット教示点107をクリックする方式を用いることができる。 First, in step S12 of FIG. 23, the user selects the offset teaching point 107 on the management screen 40 (FIG. 11(a)) and designates the start of editing. As an operation method at this time, a method of clicking the offset teaching point 107 on the management screen 40 (FIG. 11(a)) with the cursor (pointer) of the mouse of the operation input unit D can be used as described above.

図24(a)は、この時、仮想環境画面10中に仮想表示されている編集中のオフセット教示点107が定義されたロボット101の位置姿勢を示している。また、図25(a)~(c)は関節値設定部211を有するパラメータ設定画面20を示しており、図25(a)がステップS12においてオフセット教示点107を選択した直後の状態に相当する。 FIG. 24A shows the position and orientation of the robot 101 in which the offset teaching point 107 being edited, which is virtually displayed in the virtual environment screen 10 at this time, is defined. 25(a) to (c) show the parameter setting screen 20 having the joint value setting section 211, and FIG. 25(a) corresponds to the state immediately after the offset teaching point 107 is selected in step S12. .

図25(a)~(c)のパラメータ設定画面20は、例えば図5(a)~(d)(あるいは図6(a)~(d))のパラメータ設定画面20に、関節値設定部211を追加したもので、関節値設定部211以外の構成は図5(図6)のものと同様である。 The parameter setting screens 20 of FIGS. 25(a) to (c) are, for example, the parameter setting screens 20 of FIGS. 5(a) to (d) (or FIGS. 6(a) to (d)). is added, and the configuration other than the joint value setting unit 211 is the same as that of FIG. 5 (FIG. 6).

図25(a)では、パラメータ設定画面20の教示点名設定部212の表示は、教示点107に相当する「P100」に切り替えられている。教示点設定部203の値は、基準となる教示点106に対応する「P001」に切り替えられている。また、座標系選択部204の表示の通り、座標系としてはツール座標系が選択されている。 25A, the display of the teaching point name setting section 212 of the parameter setting screen 20 is switched to "P100" corresponding to teaching point 107. In FIG. The value of the teaching point setting section 203 is switched to "P001" corresponding to the teaching point 106 serving as the reference. Further, as displayed in the coordinate system selection section 204, the tool coordinate system is selected as the coordinate system.

パラメータ設定画面20の関節値設定部211は例えば6関節分の関節値(回転角度)を入力ないし表示する数値入力フィールドとなっている。これらの関節値は、上述の関節値演算に従い、オフセット教示点107の位置姿勢に対応した角度となっている。 A joint value setting portion 211 of the parameter setting screen 20 is a numerical value input field for inputting or displaying joint values (rotation angles) for six joints, for example. These joint values are angles corresponding to the position and orientation of the offset teaching point 107 according to the joint value calculation described above.

図23のステップS31において、ユーザは、関節値設定部211を用いて、オフセット教示点107に関連する任意の関節値を編集することができる(パラメータ設定手段)。例えば、図25(a)のように、パラメータ設定画面20の関節値設定部211設定欄208を操作入力部Dのマウスのカーソル205でクリックして指定する。同図では、3番の関節(図24(a)、(b)の関節101a)の設定欄208を選択している。そして、図25(b)のように、例えば操作入力部Dのキーボードを用いて関節値設定部211の設定欄208に数値入力を行う。ここでは「24.85」(図25(a))であった値を「50」に変更している。この数値入力の後、例えば操作入力部Dのキーボードで[Enter]キーを押下すると、設定欄208に対する数値入力が確定する。 In step S31 of FIG. 23, the user can edit arbitrary joint values related to the offset teaching point 107 using the joint value setting unit 211 (parameter setting means). For example, as shown in FIG. 25A, the joint value setting section 211 setting column 208 of the parameter setting screen 20 is clicked with the mouse cursor 205 of the operation input section D to specify. In the figure, the setting column 208 for the joint No. 3 (joint 101a in FIGS. 24(a) and 24(b)) is selected. Then, as shown in FIG. 25B, for example, the keyboard of the operation input unit D is used to input a numerical value in the setting column 208 of the joint value setting unit 211 . Here, the value "24.85" (FIG. 25(a)) is changed to "50". After inputting the numerical value, for example, when the [Enter] key is pressed on the keyboard of the operation input unit D, the numerical input to the setting column 208 is confirmed.

続いて、ステップS7において、CPU33は、設定した関節値がハードウェアや仕様、規約などにより定まる制約内か判断する(制約判断処理)。ここで制約外の判定の場合は、ステップS8に進み、ロボット101の姿勢が取れない旨を表示すべく、前述の図8のエラー画面50を表示し(異常系表処理)、編集前の状態に戻る。 Subsequently, in step S7, the CPU 33 determines whether or not the set joint values are within the restrictions determined by the hardware, specifications, rules, etc. (restriction determination process). If it is determined to be out of the constraints, the process proceeds to step S8 to display the error screen 50 shown in FIG. back to

ステップS7において制約内の場合は、ステップS32に進み、CPU33の計算部34の機能により位置姿勢演算を行う(姿勢計算手段)。ここでは、ロボット101の各軸の関節値より、ロボット101のベース座標系104からオフセット教示点107までの相対値を、順運動学計算で計算する。 If the constraint is satisfied in step S7, the process proceeds to step S32, where the function of the calculation unit 34 of the CPU 33 performs position/attitude calculation (attitude calculation means). Here, relative values from the base coordinate system 104 of the robot 101 to the offset teaching point 107 are calculated by forward kinematics calculation from the joint values of each axis of the robot 101 .

続いて、ステップS33において、絶対座標系(例えばベース座標系)からオフセット教示点107までの絶対値を計算する(絶対値計算処理)。例えば次式(13)のように、絶対座標系からロボット101のベース座標系104までの絶対値の姿勢行列Tと、S31の計算結果となる姿勢行列Tの積より、絶対座標系からオフセット教示点107までの絶対値の姿勢行列Tを求める。そして、式(13)より、オイラー角変換を行い、オフセット教示点107の絶対値(X、Y、Z、α、β、γ)を計算する。 Subsequently, in step S33, the absolute value from the absolute coordinate system (for example, the base coordinate system) to the offset teaching point 107 is calculated (absolute value calculation process). For example, as shown in the following equation (13), from the product of the absolute value orientation matrix T6 from the absolute coordinate system to the base coordinate system 104 of the robot 101 and the orientation matrix T3 that is the calculation result of S31, the absolute coordinate system An attitude matrix T7 of absolute values up to the offset teaching point 107 is obtained. Then, the absolute values (X, Y, Z, α, β, γ) of the offset teaching point 107 are calculated by performing the Euler angle conversion from the equation (13).

Figure 0007322099000013
Figure 0007322099000013

次にステップS4において、選択されている座標系がツール座標系105か判断する。
選択されている座標系がツール座標系105の場合はステップS14に進み、ツール座標系105の相対値計算を実行する(相対値計算処理)。また、選択されている座標系がベース座標系104の場合はステップS15に進み、ベース座標系104の相対値計算を実行する(相対値計算処理)。
Next, in step S4, it is determined whether the selected coordinate system is the tool coordinate system 105 or not.
If the selected coordinate system is the tool coordinate system 105, the process advances to step S14 to execute relative value calculation of the tool coordinate system 105 (relative value calculation process). If the selected coordinate system is the base coordinate system 104, the process advances to step S15 to execute relative value calculation of the base coordinate system 104 (relative value calculation process).

そしてステップS14またはS15の相対値計算の後、計算結果に応じて、CPU33は表示装置Cの表示画面Eを更新する(正常系表示処理)。この表示画面Eの更新においては、計算した絶対値(X、Y、Z、α、β、γ)をパラメータ設定画面20の絶対値設定部201に表示する。また、基準となる教示点106からオフセット教示点107までの相対値を表示するよう、パラメータ設定画面20の相対値設定部202の内容を更新する。また、関節値設定部211の設定欄208の各関節値により定まる位置姿勢となるよう、仮想環境画面10のロボット101の仮想表示を更新する。 After the relative value calculation in step S14 or S15, the CPU 33 updates the display screen E of the display device C according to the calculation result (normal system display processing). In updating the display screen E, the calculated absolute values (X, Y, Z, α, β, γ) are displayed in the absolute value setting section 201 of the parameter setting screen 20 . Also, the content of the relative value setting section 202 of the parameter setting screen 20 is updated so that the relative value from the reference teaching point 106 to the offset teaching point 107 is displayed. Also, the virtual display of the robot 101 on the virtual environment screen 10 is updated so that the position and orientation are determined by the joint values in the setting field 208 of the joint value setting unit 211 .

図24(b)は、上記の処理後における関節値編集後の仮想環境画面10の表示状態を、また、図25(c)は、関節値編集後のパラメータ設定画面20の表示状態を示している。 FIG. 24(b) shows the display state of the virtual environment screen 10 after editing the joint values after the above processing, and FIG. 25(c) shows the display state of the parameter setting screen 20 after editing the joint values. there is

この例では、関節値設定部211で3番の関節(関節101a)の関節値のみを変更したため、仮想環境画面10のロボット101の姿勢は、関節101aの角度のみ変更され、オフセット教示点107の位置姿勢も変更された状態になっている。また、パラメータ設定画面20では、絶対値設定部201、および相対値設定部202が関節値の変更に応じた値に変更されている。 In this example, since only the joint value of the third joint (joint 101a) is changed by the joint value setting unit 211, only the angle of the joint 101a is changed in the posture of the robot 101 on the virtual environment screen 10, and the offset teaching point 107 is changed. The position and orientation have also been changed. Also, in the parameter setting screen 20, the absolute value setting section 201 and the relative value setting section 202 are changed to values corresponding to the change of the joint value.

以上のように、本実施例によれば、関節値の表現によってロボット101ないしその関節の位置姿勢データを入力、編集することができる。そして、関節値を操作した場合でも、ユーザ(作業者)は編集作業と同時に位置姿勢と相対値のパラメータをすぐに確認できるようになり、確認に必要な工数の削減を図ることができる。 As described above, according to this embodiment, it is possible to input and edit the position and orientation data of the robot 101 or its joints by expressing joint values. Then, even when the joint values are manipulated, the user (operator) can immediately check the position/orientation and relative value parameters at the same time as the editing work, thereby reducing the man-hours required for checking.

なお、パラメータ設定画面20の絶対値設定部201、相対値設定部202、関節値設定部211は、当然のことながら、上述のCPU33による位置姿勢演算を介して相互に変換が可能である。従って、以上では関節値設定部211に入力を行う例を示したが、絶対値設定部201、相対値設定部202、関節値設定部211のいずれかを編集した場合には、位置姿勢演算を介して他の残りの2つを対応する値に更新できるのはいうまでもない。例えば、絶対値設定部201を編集した場合、姿勢計算結果より各関節値を関節値設定部211に表示することができる。また、相対値設定部202を編集した場合や、操作ハンドル111で編集した場合も同様に、姿勢計算結果より各関節値を関節値設定部211に表示することができる。 Note that the absolute value setting section 201, the relative value setting section 202, and the joint value setting section 211 of the parameter setting screen 20 can of course be mutually converted via the position/orientation calculation by the CPU 33 described above. Therefore, although an example of inputting to the joint value setting section 211 has been described above, if any of the absolute value setting section 201, the relative value setting section 202, and the joint value setting section 211 is edited, the position and orientation calculation can be performed. It goes without saying that the remaining two can be updated to corresponding values via the For example, when the absolute value setting section 201 is edited, each joint value can be displayed in the joint value setting section 211 based on the posture calculation result. Similarly, when the relative value setting section 202 is edited or when editing is performed using the operation handle 111, each joint value can be displayed in the joint value setting section 211 based on the posture calculation result.

本発明は、上述の実施例の1以上の機能を実現するプログラムを、ネットワーク又は記憶媒体を介してシステムまたは装置に供給することができる。そして、そのシステムまたは装置のコンピュータにおける1つ以上のプロセッサーがプログラムを読出し実行する処理でも実現可能である。また、1以上の機能を実現する回路(例えば、ASIC)によっても実現可能である。 The present invention can provide a program that implements one or more functions of the above-described embodiments to a system or device via a network or storage medium. It can also be realized by processing in which one or more processors in the computer of the system or apparatus read and execute the program. It can also be implemented by a circuit (for example, ASIC) that implements one or more functions.

A…情報処理装置、B…パソコン、C…表示装置、D…操作入力部、E…表示画面、10…仮想環境画面、20…パラメータ設定画面、33…CPU、34…計算部、40…管理画面、50…エラー画面、35…外部記憶装置、100…絶対座標系(ROOT)、101…ロボット(ROBOT)、102…ツール(Tool)、103…ワーク(Work)、104…ベース座標系(ROBOT)、105…ツール座標系(TCP)、106…教示点(P001)、107…オフセット教示点(P100)、110…オフセット教示点(P110)、111…操作ハンドル、201…絶対値設定部、202…相対値設定部、203…教示点設定部、204…座標系選択部、205…マウスのカーソル、206…教示点リスト、207…座標系リスト、208…設定欄、209…確定ボタン、210…キャンセルボタン、211…関節値設定部。 A... Information processing device, B... Personal computer, C... Display device, D... Operation input unit, E... Display screen, 10... Virtual environment screen, 20... Parameter setting screen, 33... CPU, 34... Calculation unit, 40... Management Screen 50... Error screen 35... External storage device 100... Absolute coordinate system (ROOT) 101... Robot (ROBOT) 102... Tool (Tool) 103... Work (Work) 104... Base coordinate system (ROBOT) ), 105... Tool coordinate system (TCP), 106... Teaching point (P001), 107... Offset teaching point (P100), 110... Offset teaching point (P110), 111... Operation handle, 201... Absolute value setting unit, 202 Relative value setting unit 203 Teaching point setting unit 204 Coordinate system selection unit 205 Mouse cursor 206 Teaching point list 207 Coordinate system list 208 Setting field 209 Enter button 210 Cancel button, 211 . . . Joint value setting section.

Claims (20)

仮想的なロボットの所定部位の位置または姿勢を設定する情報処理装置であって、
前記仮想的なロボットに関して用いられる、複数の座標系の内から第1座標系を指定する座標系指定手段と、
制御部と、を備え、
前記制御部は、表示部に、
前記第1座標系における前記所定部位の移動に対応する前記所定部位の位置または姿勢に関する第1座標値を表示すると共に、前記第1座標系以外の第2座標系における前記第1座標値に対応する前記所定部位の位置または姿勢に関する第2座標値を表示し、
前記第1座標値を入力する第1入力部と、前記第2座標値を入力する第2入力部とを、表示し、
前記第1入力部において前記第1座標値を入力した場合、前記第2座標値の表示を当該入力した前記第1座標値に対応する表示に更新し、前記第2入力部において前記第2座標値を入力した場合、前記第1座標値の表示を当該入力した前記第2座標値に対応する表示に更新する、
ことを特徴とする情報処理装置。
An information processing device for setting the position or posture of a predetermined part of a virtual robot,
coordinate system designating means for designating a first coordinate system from among a plurality of coordinate systems used for the virtual robot;
a control unit;
The control unit displays on the display unit,
displaying a first coordinate value relating to the position or orientation of the predetermined part corresponding to the movement of the predetermined part in the first coordinate system, and corresponding to the first coordinate value in a second coordinate system other than the first coordinate system; displaying a second coordinate value related to the position or posture of the predetermined part to be
displaying a first input section for inputting the first coordinate value and a second input section for inputting the second coordinate value;
When the first coordinate value is input in the first input unit, the display of the second coordinate value is updated to display corresponding to the input first coordinate value, and the second coordinate value is input in the second input unit. when a value is input, updating the display of the first coordinate value to display corresponding to the input second coordinate value;
An information processing device characterized by:
請求項1に記載の情報処理装置において、
前記制御部は、
前記第1入力部に入力された前記第1座標値に基づき、前記所定部位を移動させる、
ことを特徴とする情報処理装置。
In the information processing device according to claim 1,
The control unit
moving the predetermined part based on the first coordinate value input to the first input unit;
An information processing device characterized by:
請求項1または2に記載の情報処理装置において、
前記制御部が、前記第1座標値を、前記第1座標系から前記第2座標系に座標変換を行なうことで前記第2座標値を演算し、前記表示部に表示する、
ことを特徴とする情報処理装置。
In the information processing device according to claim 1 or 2,
The control unit performs coordinate conversion of the first coordinate value from the first coordinate system to the second coordinate system to calculate the second coordinate value, and displays the second coordinate value on the display unit.
An information processing device characterized by:
請求項1から3のいずれか1項に記載の情報処理装置において、
前記制御部が、前記第2座標値を他の装置に出力する、
ことを特徴とする情報処理装置。
In the information processing device according to any one of claims 1 to 3,
The control unit outputs the second coordinate values to another device,
An information processing device characterized by:
請求項1から4のいずれか1項に記載の情報処理装置において、
前記制御部が、前記第1座標値における前記仮想的なロボットの状態が、前記仮想的なロボットに対応する実機ロボットの機構の制約の範囲内にあるか否かを判定し、前記第1座標値に基づく前記仮想的なロボットの状態が前記機構の制約の範囲内を超える場合、エラーを通知する、
ことを特徴とする情報処理装置。
In the information processing device according to any one of claims 1 to 4,
The control unit determines whether the state of the virtual robot at the first coordinate value is within a range of constraints of a mechanism of a real robot corresponding to the virtual robot, signaling an error if the virtual robot state based on values falls outside the constraints of the mechanism;
An information processing device characterized by:
請求項2に記載の情報処理装置において、
前記表示部には、前記第1座標値及び前記第2座標値を表示するパラメータ表示部と、前記仮想的なロボットのモデルおよび前記仮想的なロボットに設定される教示点を表示するモデル表示部とが表示される、
ことを特徴とする情報処理装置。
In the information processing apparatus according to claim 2,
The display unit includes a parameter display unit that displays the first coordinate value and the second coordinate value, and a model display unit that displays the virtual robot model and teaching points set in the virtual robot. is displayed,
An information processing device characterized by:
請求項6に記載の情報処理装置において、
前記制御部が、前記第1入力部によって入力された前記第1座標値に基づき、前記第1座標系における新たな教示点を前記モデル表示部に表示する、
ことを特徴とする情報処理装置。
In the information processing device according to claim 6,
The control unit displays a new teaching point in the first coordinate system on the model display unit based on the first coordinate values input by the first input unit.
An information processing device characterized by:
請求項7に記載の情報処理装置において、
前記制御部が、前記新たな教示点に関する前記第2座標系における座標値を前記パラメータ表示部に表示する、
ことを特徴とする情報処理装置。
In the information processing device according to claim 7,
The control unit displays coordinate values in the second coordinate system for the new teaching point on the parameter display unit.
An information processing device characterized by:
請求項1から8のいずれか1項に記載の情報処理装置において、
前記制御部が、前記所定部位と依存関係にある部位がある場合、前記所定部位に関する情報と、前記依存関係にある部位に関する情報と、を階層構造データとして前記表示部に表示する、
ことを特徴とする情報処理装置。
In the information processing device according to any one of claims 1 to 8,
When there is a site that has a dependency relationship with the predetermined site, the control unit displays information about the predetermined site and information about the site that has the dependency relationship as hierarchical structure data on the display unit.
An information processing device characterized by:
請求項1から9のいずれか1項に記載の情報処理装置において、前記所定部位は前記仮想的なロボットの先端である、
ことを特徴とする情報処理装置。
10. The information processing apparatus according to any one of claims 1 to 9, wherein the predetermined part is the tip of the virtual robot,
An information processing device characterized by:
請求項6から8のいずれか1項に記載の情報処理装置において、
前記モデル表示部が、前記仮想的なロボットを、前記仮想的なロボットに対応する実機ロボットの作動環境に擬した仮想空間中に前記仮想的なロボットの3D画像をレンダリングして成る3Dモデル表現により表示する、
ことを特徴とする情報処理装置。
In the information processing device according to any one of claims 6 to 8,
The model display unit renders a 3D image of the virtual robot in a virtual space simulating an operating environment of a real robot corresponding to the virtual robot by a 3D model representation. indicate,
An information processing device characterized by:
請求項1から11のいずれか1項に記載の情報処理装置において、
前記複数の座標系は、前記仮想的なロボットに関して用いられる絶対座標系と、前記絶対座標系に対する相対座標系を含み、
前記第1座標系は前記相対座標系であり、前記第2座標系は前記絶対座標系である、
ことを特徴とする情報処理装置。
In the information processing apparatus according to any one of claims 1 to 11,
The plurality of coordinate systems includes an absolute coordinate system used for the virtual robot and a relative coordinate system to the absolute coordinate system,
The first coordinate system is the relative coordinate system, and the second coordinate system is the absolute coordinate system.
An information processing device characterized by:
請求項7に記載の情報処理装置において、
前記新たな教示点を設定する際に、前記第1座標系における所定位置に前記教示点をオフセットして複製できる、
ことを特徴とする情報処理装置。
In the information processing device according to claim 7,
When setting the new teaching point, the teaching point can be offset and duplicated at a predetermined position in the first coordinate system.
An information processing device characterized by:
請求項13に記載の情報処理装置において、
前記教示点から前記オフセットの基準となる基準教示点を設定する教示点設定部をさらに備える、
ことを特徴とする情報処理装置。
In the information processing device according to claim 13,
further comprising a teaching point setting unit that sets a reference teaching point that serves as a reference for the offset from the teaching point;
An information processing device characterized by:
請求項12に記載の情報処理装置において、
前記複数の座標系は前記相対座標系を複数含み、
前記制御部は、
前記複数の座標系から前記座標系指定手段により前記第1座標系が新たに指定されたことで指定前の前記第1座標系から新たな前記第1座標系に切り換えられた場合、前記第1座標値の表示を前記第1座標系の切換に応じて更新する、
ことを特徴とする情報処理装置。
In the information processing device according to claim 12,
The plurality of coordinate systems includes a plurality of the relative coordinate systems,
The control unit
When the first coordinate system is newly specified by the coordinate system specifying means from among the plurality of coordinate systems and the first coordinate system before specification is switched to the new first coordinate system, the first coordinate system updating the display of the coordinate values in accordance with the switching of the first coordinate system;
An information processing device characterized by:
請求項1に記載の情報処理装置において、
前記第1座標系において前記所定部位を移動させる際の操作ハンドルに対応するモデルをさらに表示する、
ことを特徴とする情報処理装置。
In the information processing device according to claim 1,
further displaying a model corresponding to an operation handle for moving the predetermined part in the first coordinate system;
An information processing device characterized by:
請求項1から16のいずれか1項に記載の情報処理装置と、前記情報処理装置によって設定された前記仮想的なロボットに対応する実機ロボットの所定部位の位置または姿勢の情報を取得するコントローラと
当該実機ロボットと、を備え、
前記コントローラは、取得した当該実機ロボットの所定部位の位置または姿勢の情報に基づき当該実機ロボットの動作を制御する、
ことを特徴とするロボット装置。
The information processing device according to any one of claims 1 to 16, and a controller that acquires position or orientation information of a predetermined part of a real robot corresponding to the virtual robot set by the information processing device. and the actual robot,
The controller controls the motion of the actual robot based on the acquired information on the position or orientation of the predetermined part of the actual robot.
A robot device characterized by:
仮想的なロボットの所定部位の位置または姿勢を設定する情報処理方法であって、
前記仮想的なロボットに関して用いられる複数の座標系の内から、座標系指定手段により第1座標系の指定を受け付ける受付工程と、
前記第1座標系における前記所定部位の移動に対応する前記所定部位の位置または姿勢に関する第1座標値を表示すると共に、前記第1座標系以外の第2座標系における前記第1座標値に対応する前記所定部位の位置または姿勢に関する第2座標値を表示する表示工程と、を実行し、
前記表示工程において、表示されている第1入力部に前記第1座標値を入力した場合、前記第2座標値の表示を当該入力した前記第1座標値に対応する表示に更新し、表示されている第2入力部に前記第2座標値を入力した場合、前記第1座標値の表示を当該入力した前記第2座標値に対応する表示に更新する、
ことを特徴とする情報処理方法。
An information processing method for setting the position or posture of a predetermined part of a virtual robot,
a receiving step of receiving designation of a first coordinate system by a coordinate system designating means from among a plurality of coordinate systems used for the virtual robot;
displaying a first coordinate value relating to the position or orientation of the predetermined part corresponding to the movement of the predetermined part in the first coordinate system, and corresponding to the first coordinate value in a second coordinate system other than the first coordinate system; a display step of displaying a second coordinate value related to the position or posture of the predetermined part,
In the display step, when the first coordinate value is input to the displayed first input unit , the display of the second coordinate value is updated to the display corresponding to the input first coordinate value, and displayed. updating the display of the first coordinate value to a display corresponding to the input second coordinate value when the second coordinate value is input to the second input unit,
An information processing method characterized by:
請求項18に記載の情報処理方法における前記受付工程と前記表示工程と、をコンピュータに実行させるためのプログラム。 19. A program for causing a computer to execute the reception step and the display step in the information processing method according to claim 18. 請求項19に記載のプログラムを格納した、コンピュータ読み取り可能な記録媒体。 A computer-readable recording medium storing the program according to claim 19.
JP2021099342A 2020-03-11 2021-06-15 Information processing method, information processing device, robot device, program, and computer-readable recording medium Active JP7322099B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2021099342A JP7322099B2 (en) 2020-03-11 2021-06-15 Information processing method, information processing device, robot device, program, and computer-readable recording medium

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020042459A JP6900533B2 (en) 2015-05-12 2020-03-11 Information processing methods, information processing devices, robot devices, information processing programs, and computer-readable recording media
JP2021099342A JP7322099B2 (en) 2020-03-11 2021-06-15 Information processing method, information processing device, robot device, program, and computer-readable recording medium

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2020042459A Division JP6900533B2 (en) 2015-05-12 2020-03-11 Information processing methods, information processing devices, robot devices, information processing programs, and computer-readable recording media

Publications (2)

Publication Number Publication Date
JP2021151696A JP2021151696A (en) 2021-09-30
JP7322099B2 true JP7322099B2 (en) 2023-08-07

Family

ID=77887065

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021099342A Active JP7322099B2 (en) 2020-03-11 2021-06-15 Information processing method, information processing device, robot device, program, and computer-readable recording medium

Country Status (1)

Country Link
JP (1) JP7322099B2 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001282331A (en) 2000-03-30 2001-10-12 Toyoda Mach Works Ltd Machine tool simulation device
JP2006142480A (en) 2006-02-23 2006-06-08 Fanuc Ltd Teaching operation panel of robot
JP2011224696A (en) 2010-04-19 2011-11-10 Yaskawa Electric Corp Robot teaching replaying device and teaching replaying method
JP2014161921A (en) 2013-02-21 2014-09-08 Yaskawa Electric Corp Robot simulator, robot teaching device and robot teaching method

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2742959B2 (en) * 1990-09-20 1998-04-22 三菱電機株式会社 Laser processing equipment
JPH06274221A (en) * 1993-03-18 1994-09-30 Shin Meiwa Ind Co Ltd Method for copying program data for industrial robot
JPH08263120A (en) * 1995-03-24 1996-10-11 Fanuc Ltd Current position display system for cnc

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001282331A (en) 2000-03-30 2001-10-12 Toyoda Mach Works Ltd Machine tool simulation device
JP2006142480A (en) 2006-02-23 2006-06-08 Fanuc Ltd Teaching operation panel of robot
JP2011224696A (en) 2010-04-19 2011-11-10 Yaskawa Electric Corp Robot teaching replaying device and teaching replaying method
JP2014161921A (en) 2013-02-21 2014-09-08 Yaskawa Electric Corp Robot simulator, robot teaching device and robot teaching method

Also Published As

Publication number Publication date
JP2021151696A (en) 2021-09-30

Similar Documents

Publication Publication Date Title
JP6676286B2 (en) Information processing method and information processing apparatus
US11007646B2 (en) Programming assistance apparatus, robot system, and method for generating program
JP6469162B2 (en) Offline teaching device for robots
JP2001105359A (en) Graphic display device for robot system
JPH08249026A (en) Programming method for system including robot
JP2017213644A (en) Teaching device, teaching system, robot system, teaching method, method for manufacturing product, program and recording medium
JP2005135095A (en) Robot operation data generating device
JP6900533B2 (en) Information processing methods, information processing devices, robot devices, information processing programs, and computer-readable recording media
WO2019064919A1 (en) Robot teaching device
JP7322099B2 (en) Information processing method, information processing device, robot device, program, and computer-readable recording medium
CN115008439A (en) Information processing apparatus and method, robot system, product manufacturing method, and computer program product
WO2019021045A1 (en) Method and system for parmeter based operation of an industrial robot
JPH08286722A (en) Off-line teaching method using cad data and its system
JPH02176906A (en) Operating state display, operating instruction controller and controller
JP7167925B2 (en) Robot teaching device
JP2021084218A (en) Information presentation device, information presentation method, and information presentation program
JP7024795B2 (en) Robot teaching device
JP7099470B2 (en) Robot teaching device
JP3172846B2 (en) Shape processing equipment
Chen et al. Offline Programming for an Arc Welding Robot with Redundant DOF
JP2021167037A (en) Simulation device, simulation method and simulation program
JP2022165170A (en) Information processing device, information processing method, control program, recording medium, program generation method, and article manufacturing method
JP2022135939A (en) Information processor, robot system, article manufacturing method, information processing method, program, and recording medium
JPH0735031B2 (en) Robot's offline pro-milling device
Pandey A Handbook for 3D Create

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210707

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210707

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220518

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220628

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220826

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20221220

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230317

C60 Trial request (containing other claim documents, opposition documents)

Free format text: JAPANESE INTERMEDIATE CODE: C60

Effective date: 20230317

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20230324

C21 Notice of transfer of a case for reconsideration by examiners before appeal proceedings

Free format text: JAPANESE INTERMEDIATE CODE: C21

Effective date: 20230328

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230418

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230616

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: 20230627

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230726

R151 Written notification of patent or utility model registration

Ref document number: 7322099

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151