Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP4882990B2 - Robot controller - Google Patents
[go: Go Back, main page]

JP4882990B2 - Robot controller - Google Patents

Robot controller Download PDF

Info

Publication number
JP4882990B2
JP4882990B2 JP2007319554A JP2007319554A JP4882990B2 JP 4882990 B2 JP4882990 B2 JP 4882990B2 JP 2007319554 A JP2007319554 A JP 2007319554A JP 2007319554 A JP2007319554 A JP 2007319554A JP 4882990 B2 JP4882990 B2 JP 4882990B2
Authority
JP
Japan
Prior art keywords
robot
general
specific
dedicated
parameter
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2007319554A
Other languages
Japanese (ja)
Other versions
JP2009142903A (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.)
Denso Wave Inc
Original Assignee
Denso Wave Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Denso Wave Inc filed Critical Denso Wave Inc
Priority to JP2007319554A priority Critical patent/JP4882990B2/en
Publication of JP2009142903A publication Critical patent/JP2009142903A/en
Application granted granted Critical
Publication of JP4882990B2 publication Critical patent/JP4882990B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Description

本発明は、ロボット制御装置に関し、特に動作領域ごとに要求されるロボットの制御精度に応じて適用するパラメータを変更するロボット制御装置に関する。   The present invention relates to a robot control device, and more particularly to a robot control device that changes parameters to be applied according to the control accuracy of a robot required for each operation region.

産業用ロボットのシステムにおいては、動作時における制御精度を高めるために、各種のパラメータを高精度に同定する必要がある。ロボットは、例えば駆動力を発生するアクチュエータ、アクチュエータの位置を検出するエンコーダ、アクチュエータの駆動力をアームに伝達するリンク機構などを備えている。そのため、これらアクチュエータ、エンコーダおよびリンクなどに生じるわずかな誤差は、パラメータを利用して補正される(特許文献1参照)。
特開平6−304893号公報
In an industrial robot system, it is necessary to identify various parameters with high accuracy in order to increase control accuracy during operation. The robot includes, for example, an actuator that generates a driving force, an encoder that detects the position of the actuator, a link mechanism that transmits the driving force of the actuator to an arm, and the like. Therefore, slight errors occurring in these actuators, encoders, links, and the like are corrected using parameters (see Patent Document 1).
JP-A-6-304893

特許文献1の場合、ロボットで想定されている任意の動作領域における任意の動作についての精度の向上を目的としてパラメータを設定するためにキャリブレーションを行う。そのため、ロボットの動作領域における各動作の平均精度は向上する。
しかしながら、これは単に各動作の平均精度が向上するだけであり、例えば同一の動作点において姿勢を変化させる動作など、限定された動作領域内の限定された動作などでは、精度が平均精度より悪くなり、十分な精度が確保できないという問題が発生する場合がある。
In the case of Patent Document 1, calibration is performed in order to set parameters for the purpose of improving the accuracy of an arbitrary motion in an arbitrary motion region assumed by the robot. For this reason, the average accuracy of each motion in the motion region of the robot is improved.
However, this only improves the average accuracy of each motion, and the accuracy is worse than the average accuracy in a limited motion within a limited motion area, such as a motion that changes the posture at the same motion point. Therefore, there may be a problem that sufficient accuracy cannot be secured.

そこで、本発明は、上記の課題に鑑みてなされたものであり、その目的は、ロボットに想定されている可動領域全体における各種動作、およびロボットの特定の領域における特定の動作について、両立して高い精度が確保されるロボット制御装置を提供することにある。   Therefore, the present invention has been made in view of the above-described problems, and the purpose of the present invention is compatible with various operations in the entire movable region assumed for the robot and specific operations in a specific region of the robot. An object of the present invention is to provide a robot control device that ensures high accuracy.

請求項1記載の発明では、汎用パラメータを取得する汎用パラメータ取得手段および専用パラメータを取得する専用パラメータ取得手段を備えている。汎用パラメータは、ロボットの可動領域全体からまんべんなく選ばれた目的点および各種動作についてロットの制御の基礎となる汎用パラメータを取得する。一方、専用パラメータは、この可動領域の一部に設定された特定領域における特定動作に専用の専用パラメータを取得する。動作制御調整手段は、実行プログラムに基づくロボットの動作が特定領域における特定動作であるとき、専用パラメータを適用してロボットを制御するのに対し、ロボットの動作が特定領域における特定動作でないと判断したとき、汎用パラメータを適用してロボットを制御する。このように、動作制御調整手段は、ロボットの動作が特定領域における特定動作であるとき、専用パラメータを適用してロボットを制御し、それ以外のとき、汎用パラメータを適用してロボットを制御する。そのため、ロボットの動作が特定領域における特定動作にあるとき、ロボットはその特定領域における特定動作のために専用に設定された専用パラメータによって高精度に制御される。一方、ロボットの動作が特定領域における特定動作でないとき、ロボットの制御の基礎として設定された汎用パラメータによって高精度に制御される。したがって、ロボットの任意の領域における任意の動作における精度の確保と、ロボットの特定の領域における特定の動作における精度の確保とを両立して達成することができる。   According to the first aspect of the present invention, there are provided general-purpose parameter acquisition means for acquiring general-purpose parameters and dedicated parameter acquisition means for acquiring dedicated parameters. The general-purpose parameters acquire general-purpose parameters that serve as a basis for lot control with respect to the target points and various operations that are uniformly selected from the entire movable region of the robot. On the other hand, the dedicated parameter acquires a dedicated parameter dedicated to a specific operation in a specific area set as a part of the movable area. The motion control adjustment means determines that the robot motion is not a specific motion in the specific region, while the robot operation based on the execution program is a specific motion in the specific region to control the robot by applying a dedicated parameter. When the robot is controlled by applying general parameters. In this way, the motion control adjustment means controls the robot by applying the dedicated parameter when the motion of the robot is the specific motion in the specific region, and controls the robot by applying the general parameter otherwise. Therefore, when the robot motion is in a specific motion in a specific region, the robot is controlled with high accuracy by a dedicated parameter set exclusively for the specific motion in the specific region. On the other hand, when the movement of the robot is not a specific movement in a specific area, the robot is controlled with high accuracy by the general-purpose parameters set as the basis of the robot control. Therefore, it is possible to achieve both ensuring accuracy in an arbitrary operation in an arbitrary region of the robot and ensuring accuracy in a specific operation in a specific region of the robot.

以下、本発明によるロボット制御装置の一実施形態を図面に基づいて説明する。
図1および図2は、本実施形態によるロボット制御装置を適用したロボットシステム10を示す。図1は、ロボットシステム10の構成を示すブロック図である。図2は、ロボットシステム10の構成を示す概略図である。ロボットシステム10は、ロボット11および制御装置12を備えている。ロボット11は、例えば部品の組み立て用あるいは部品の検査用など、任意の構成のロボットである。制御装置12は、周辺機器として操作ペンダントを構成するティーチィングペンダント13およびプログラム入力用のパソコン14などが接続されている。
Hereinafter, an embodiment of a robot control apparatus according to the present invention will be described with reference to the drawings.
1 and 2 show a robot system 10 to which the robot control apparatus according to the present embodiment is applied. FIG. 1 is a block diagram showing the configuration of the robot system 10. FIG. 2 is a schematic diagram showing the configuration of the robot system 10. The robot system 10 includes a robot 11 and a control device 12. The robot 11 is a robot having an arbitrary configuration, for example, for assembling parts or for inspecting parts. The control device 12 is connected to a teaching pendant 13 constituting an operation pendant as a peripheral device, a personal computer 14 for program input, and the like.

ロボット11は、例えば六軸の垂直多関節型のロボットとして構成されている。ロボット11は、周知の通り、それぞれアクチュエータであるサーボモータ15などからの駆動力で駆動されるアーム16を有している。アーム16は、先端にエンドエフェクタ17を有している。例えばロボット11で部品の運搬や組み立てなどを行う場合、エンドエフェクタ17としてこれらの部品を保持するためのハンドが用いられる。また、例えばロボット11で部品の検査などを行う場合、エンドエフェクタ17として対象となる部品を撮影するカメラなどが用いられる。このように、エンドエフェクタ17は、ロボット11を適用する工程に応じて任意に選択することができる。サーボモータ15からアーム16のエンドエフェクタ17までの間には、図示しない減速機構やリンクなどの駆動力伝達機構が設けられている。これにより、アーム16の先端に設けられているエンドエフェクタ17は、サーボモータ15からの駆動力によって駆動される。ロボット11と制御装置12との間は、接続ケーブル18によって接続されている。これにより、ロボット11の各軸を駆動するサーボモータ15、および作業を実施するエンドエフェクタ17は、制御装置12によって制御される。   The robot 11 is configured as a six-axis vertical articulated robot, for example. As is well known, the robot 11 has an arm 16 that is driven by a driving force from a servo motor 15 that is an actuator. The arm 16 has an end effector 17 at the tip. For example, when parts are transported or assembled by the robot 11, a hand for holding these parts is used as the end effector 17. For example, when a part 11 is inspected by the robot 11, a camera for photographing a target part is used as the end effector 17. Thus, the end effector 17 can be arbitrarily selected according to the process of applying the robot 11. Between the servo motor 15 and the end effector 17 of the arm 16, a driving force transmission mechanism such as a speed reduction mechanism or a link (not shown) is provided. As a result, the end effector 17 provided at the tip of the arm 16 is driven by the driving force from the servo motor 15. The robot 11 and the control device 12 are connected by a connection cable 18. Accordingly, the servo motor 15 that drives each axis of the robot 11 and the end effector 17 that performs the work are controlled by the control device 12.

ティーチィングペンダント13は、例えばユーザが携帯あるいは手に所持して操作可能な程度の大きさで構成されている。ティーチィングペンダント13は、例えば薄型の略矩形箱状に形成されている。ティーチィングペンダント13は、表面部の中央部に例えば液晶ディスプレイからなる表示部21を有している。表示部21には、各種の画面が表示される。表示部21は、タッチパネルで構成されている。また、ティーチィングペンダント13は、表示部21の周囲に各種のキースイッチ22が設けられている。タッチパネルおよびキースイッチ22は、制御装置12へ種々の指示を入力するキー操作部23を構成している。   The teaching pendant 13 is configured, for example, in such a size that the user can carry it or carry it in his hand. The teaching pendant 13 is formed in a thin, substantially rectangular box shape, for example. The teaching pendant 13 has a display part 21 made of, for example, a liquid crystal display at the center of the surface part. Various screens are displayed on the display unit 21. The display unit 21 is configured with a touch panel. Further, the teaching pendant 13 is provided with various key switches 22 around the display unit 21. The touch panel and the key switch 22 constitute a key operation unit 23 for inputting various instructions to the control device 12.

ティーチィングペンダント13の内部には、制御回路24および図示しないインターフェイスなどが設けられている。制御回路24は、マイクロコンピュータを主体として構成されている。ティーチィングペンダント13は、インターフェイスを経由して制御装置12との間で高速のデータ転送を実行する。ティーチィングペンダント13は、ケーブル25を経由して制御装置12に接続している。ティーチィングペンダント13のキー操作部23から入力された操作信号などは、ケーブル25を経由してティーチィングペンダント13から制御装置12へ送信される。また、制御装置12は、ティーチィングペンダント13へ制御信号や表示用の信号などとともに、駆動用の電力を供給する。   Inside the teaching pendant 13, a control circuit 24 and an interface (not shown) are provided. The control circuit 24 is mainly composed of a microcomputer. The teaching pendant 13 performs high-speed data transfer with the control device 12 via the interface. The teaching pendant 13 is connected to the control device 12 via a cable 25. An operation signal or the like input from the key operation unit 23 of the teaching pendant 13 is transmitted from the teaching pendant 13 to the control device 12 via the cable 25. Further, the control device 12 supplies driving power to the teaching pendant 13 together with a control signal and a display signal.

ユーザは、上記のティーチィングペンダント13を用いてロボット11の運転や設定などの各種の機能を実行可能である。具体的には、ユーザは、キー操作部23を操作することにより、予め記憶されているロボット11のプログラムを呼び出して、ロボット11の起動や各種のパラメータの設定などを実行することができる。また、ロボット11をマニュアル操作により動作させて各種の教示作業も実行可能である。このとき、表示部21には、例えばメニュー画面、設定入力画面、状況表示画面など必要に応じて所望の画面が表示される。   The user can execute various functions such as operation and setting of the robot 11 using the teaching pendant 13 described above. Specifically, the user can call the program of the robot 11 stored in advance by operating the key operation unit 23 to execute the activation of the robot 11 and the setting of various parameters. Also, various teaching operations can be executed by operating the robot 11 by manual operation. At this time, a desired screen such as a menu screen, a setting input screen, and a status display screen is displayed on the display unit 21 as necessary.

パソコン14には、例えば汎用のノートパソコンなどが適用される。パソコン14でプログラミングソフトを実行させることにより、ユーザはアプリケーションに応じてロボット11の動作手順などを記述したロボットプログラムを作成することができる。この場合、ユーザは、ロボット11で実行するアプリケーションに応じて、パッケージ命令を組み合わせたり、修正を加えたりすることにより、比較的簡単にロボット11の動作プログラムを作成することができる。このパソコン14は、ケーブル26を経由して制御装置12に接続している。パソコン14で作成されたロボット11の動作プログラムは、ケーブル26を経由してパソコン14から制御装置12へ入力される。   As the personal computer 14, for example, a general-purpose notebook personal computer or the like is applied. By executing the programming software on the personal computer 14, the user can create a robot program describing the operation procedure of the robot 11 according to the application. In this case, the user can create an operation program for the robot 11 relatively easily by combining package commands or adding corrections according to the application executed by the robot 11. The personal computer 14 is connected to the control device 12 via a cable 26. The operation program of the robot 11 created by the personal computer 14 is input from the personal computer 14 to the control device 12 via the cable 26.

制御装置12は、箱状のフレームの内部に制御部31が組み込まれている。制御部31は、CPU、ROMおよびRAMなどからなるマイクロコンピュータを主体として構成されている。制御部31は、予め入力、記憶されたロボット11の動作プログラムや、各種データおよびパラメータ、ティーチィングペンダント13からの操作信号などに基づいて、サーボ制御部32を経由してロボット11の各軸のサーボモータ15を駆動する。これにより、制御装置12は、ロボット11の動作を制御する。   In the control device 12, a control unit 31 is incorporated in a box-shaped frame. The control unit 31 is mainly configured by a microcomputer including a CPU, a ROM, a RAM, and the like. The control unit 31 inputs each of the axes of the robot 11 via the servo control unit 32 based on the operation program of the robot 11 input and stored in advance, various data and parameters, operation signals from the teaching pendant 13, and the like. The servo motor 15 is driven. Thereby, the control device 12 controls the operation of the robot 11.

制御装置12は、上記の構成に加え、エンコーダ33、記憶部34、汎用パラメータ取得部35、専用パラメータ取得部36、判断部37および動作制御調整部38を有している。エンコーダ33は、サーボモータ15の動作量を検出する。エンコーダ33は、例えばサーボモータ15の回転角度などを検出する。エンコーダ33は、検出したサーボモータ15の回転角度を電気信号として制御部31へ出力する。記憶部34は、ロボット11の動作プログラム、各種データあるいはパラメータなどを記憶する。記憶部34は、例えばEPPROMなどの不揮発性の記憶素子やHDDなどから構成されている。また、制御部31を構成するROMおよびRAMによって記憶部34を構成してもよい。   In addition to the above configuration, the control device 12 includes an encoder 33, a storage unit 34, a general-purpose parameter acquisition unit 35, a dedicated parameter acquisition unit 36, a determination unit 37, and an operation control adjustment unit 38. The encoder 33 detects the operation amount of the servo motor 15. The encoder 33 detects, for example, the rotation angle of the servo motor 15. The encoder 33 outputs the detected rotation angle of the servo motor 15 to the control unit 31 as an electrical signal. The storage unit 34 stores an operation program, various data, parameters, and the like of the robot 11. The storage unit 34 includes a nonvolatile storage element such as an EPPROM, an HDD, and the like. Further, the storage unit 34 may be configured by a ROM and a RAM configuring the control unit 31.

汎用パラメータ取得部35は、ロボット11の動作に適用する汎用パラメータを取得する。汎用パラメータは、ロボット11の可動領域全体からまんべんなく選ばれた目的点および各種動作についてのキャリブレーションを実行することにより取得される。汎用パラメータは、ロボット11に想定される可動領域のすべてにおいて想定されるすべての動作に適用可能である。すなわち、汎用パラメータは、ロボット11の可動領域のすべてにおけるすべての動作に適用されるロボット11の制御の基礎となるパラメータである。汎用パラメータ取得部35は、ティーチィングペンダント13またはパソコン14から入力されたロボット11の動作の繰り返し、あるいは予め設定された汎用パラメータ取得プログラムによるロボット11の動作の繰り返しにより、ロボット11のキャリブレーションを実行し、汎用パラメータを取得する。   The general parameter acquisition unit 35 acquires general parameters to be applied to the operation of the robot 11. The general-purpose parameters are acquired by executing calibration for the target points and various operations that are uniformly selected from the entire movable region of the robot 11. The general-purpose parameters can be applied to all operations assumed in all the movable regions assumed for the robot 11. That is, the general-purpose parameters are parameters that serve as a basis for control of the robot 11 that is applied to all operations in all the movable regions of the robot 11. The general-purpose parameter acquisition unit 35 executes calibration of the robot 11 by repeating the operation of the robot 11 input from the teaching pendant 13 or the personal computer 14 or by repeating the operation of the robot 11 by a preset general-purpose parameter acquisition program. And get general parameters.

汎用パラメータ取得部35は、ロボット11の動作領域の全体ですべての動作について適用可能なキャリブレーションを実行し、汎用パラメータを取得する。なお、汎用パラメータ取得部35は、ロボット11の動作領域のうち代表となる領域、および代表となる動作のキャリブレーションを実行し、動作領域の全体におけるすべての動作に適用される汎用パラメータを算出する構成としてもよい。汎用パラメータ取得部35は、キャリブレーションの結果として取得した汎用パラメータを記憶部34に記憶する。   The general-purpose parameter acquisition unit 35 executes calibration applicable to all operations in the entire operation region of the robot 11 and acquires general-purpose parameters. The general-purpose parameter acquisition unit 35 performs calibration of a representative region of the motion region of the robot 11 and the representative motion, and calculates general-purpose parameters that are applied to all motions in the entire motion region. It is good also as a structure. The general parameter acquisition unit 35 stores the general parameters acquired as a result of the calibration in the storage unit 34.

専用パラメータ取得部36は、ロボット11の動作に適用する専用パラメータを取得する。専用パラメータは、ロボット11の可動領域のうちの一部に設定されている特定領域において、ロボット11に設定されている動作のうち一部の特定動作についてのキャリブレーションを実行することにより取得される。専用パラメータは、ロボット11に想定される可動領域のうちの一部である特定領域において、ロボット11に想定される動作のうちの一部である特定動作についてのみ適用される。すなわち、専用パラメータは、ロボット11の特定領域における特定動作にのみ適用され、その特定領域における特定動作に専用のパラメータである。専用パラメータ取得部36は、ティーチィングペンダント13またはパソコン14から入力されたロボット11の動作の繰り返し、あるいは予め設定された専用パラメータ取得プログラムによるロボット11の動作の繰り返しにより、ロボット11のキャリブレーションを実行し、専用パラメータを取得する。このとき、専用パラメータ取得部36は、ロボット11で特定領域における特定動作を繰り返す。これにより、特定領域における特定動作についてのキャリブレーションが実行される。専用パラメータ取得部36は、キャリブレーションの結果として取得した専用パラメータを記憶部34に記憶する。   The dedicated parameter acquisition unit 36 acquires a dedicated parameter applied to the operation of the robot 11. The dedicated parameter is acquired by executing calibration for some specific operations among the operations set in the robot 11 in a specific region set in a part of the movable region of the robot 11. . The dedicated parameter is applied only to a specific operation that is a part of the motion assumed for the robot 11 in a specific region that is a part of the movable region assumed for the robot 11. That is, the dedicated parameter is applied only to a specific operation in the specific area of the robot 11 and is a parameter dedicated to the specific operation in the specific area. The dedicated parameter acquisition unit 36 performs calibration of the robot 11 by repeating the operation of the robot 11 input from the teaching pendant 13 or the personal computer 14 or by repeating the operation of the robot 11 by a preset dedicated parameter acquisition program. And get the dedicated parameters. At this time, the dedicated parameter acquisition unit 36 repeats the specific operation in the specific area by the robot 11. Thereby, the calibration for the specific operation in the specific region is executed. The dedicated parameter acquisition unit 36 stores the dedicated parameter acquired as a result of the calibration in the storage unit 34.

汎用パラメータ取得部35および専用パラメータ取得部36は、ロボット11の各軸について、次のパラメータを取得する。汎用パラメータ取得部35および専用パラメータ取得部36は、例えば回転軸iの回転角θi、回転軸iによって駆動されるリンクLi、回転軸iと回転軸i+1との間のリンク長ai、リンクLiのz軸からリンクLi+1のz軸までのxi軸まわりの回転角αi、および回転角θiのオフセット量Δθiなどのうちの全部または一部をパラメータとして取得する。   The general parameter acquisition unit 35 and the dedicated parameter acquisition unit 36 acquire the following parameters for each axis of the robot 11. The general-purpose parameter acquisition unit 35 and the dedicated parameter acquisition unit 36 include, for example, the rotation angle θi of the rotation axis i, the link Li driven by the rotation axis i, the link length ai between the rotation axis i and the rotation axis i + 1, and the link Li All or part of the rotation angle αi around the xi axis from the z axis to the z axis of the link Li + 1, the offset amount Δθi of the rotation angle θi, and the like are acquired as parameters.

汎用パラメータが適用されるロボット11の動作は、ロボット11に想定されるすべての動作である。汎用パラメータおよび専用パラメータには、エンコーダ33のオフセット量、駆動力伝達機構の誤差量および直角度などの任意のパラメータが含まれる。専用パラメータが適用されるロボット11の動作としては、例えば同一点における姿勢変化動作、同一点を対象とする画像撮影動作、ある同一の領域内で設定された複数の動作、およびパレタイジング動作などがある。このように、ロボット11の動作が限定された特定の領域内において、限定された特定の動作であるとき、制御装置12によるロボット11の制御には専用パラメータが適用される。   The operations of the robot 11 to which the general-purpose parameters are applied are all operations assumed for the robot 11. The general-purpose parameters and the dedicated parameters include arbitrary parameters such as the offset amount of the encoder 33, the error amount of the driving force transmission mechanism, and the squareness. Examples of the operation of the robot 11 to which the dedicated parameter is applied include an attitude change operation at the same point, an image shooting operation for the same point, a plurality of operations set in a certain region, a palletizing operation, and the like. . As described above, the dedicated parameter is applied to the control of the robot 11 by the control device 12 when the operation of the robot 11 is a limited specific operation in a specific region where the operation of the robot 11 is limited.

判断部37は、ロボット11の動作が特定領域における特定動作であるか否かを判断する。そして、動作制御調整部38は、判断部37でロボット11の動作領域および動作を判断した結果、汎用パラメータを適用する領域および動作であるか、専用パラメータを適用する領域および動作であるかを判断する。制御装置12には、ティーチィングペンダント13またはパソコン14からロボット11で実行する動作が入力される。動作制御調整部38は、この入力された動作が特定領域における特定動作であるか否かを判断する。動作制御調整部38は、図3に示すように制御部31に入力されたアプリケーションに基づくロボット11の動作領域およびその動作から適用するパラメータの種類を判断する。具体的には、ロボット11の動作領域が特定領域内であって、ロボット11の動作が特定動作であるとき、動作制御調整部38は専用パラメータを適用すると判断する。一方、ロボット11の動作領域が特定領域内であっても特定動作でないとき、ロボット11の動作が特定動作であっても動作領域が特定領域外であるとき、およびロボット11の動作領域が特定領域外であり特定動作でもないとき、動作制御調整部38はいずれも汎用パラメータを適用すると判断する。   The determination unit 37 determines whether the operation of the robot 11 is a specific operation in a specific area. Then, as a result of determining the motion region and motion of the robot 11 by the determination unit 37, the motion control adjustment unit 38 determines whether it is a region and motion to which general parameters are applied or a region and motion to which dedicated parameters are applied. To do. An operation to be executed by the robot 11 is input to the control device 12 from the teaching pendant 13 or the personal computer 14. The operation control adjustment unit 38 determines whether or not the input operation is a specific operation in a specific area. The motion control adjustment unit 38 determines the motion region of the robot 11 based on the application input to the control unit 31 and the type of parameter to be applied from the motion, as shown in FIG. Specifically, when the motion region of the robot 11 is within the specific region and the motion of the robot 11 is the specific motion, the motion control adjustment unit 38 determines to apply the dedicated parameter. On the other hand, when the motion area of the robot 11 is within the specific area but not the specific motion, the motion area of the robot 11 is outside the specific area even when the motion of the robot 11 is the specific motion, and the motion area of the robot 11 is the specific area When it is outside and is not a specific operation, the operation control adjustment unit 38 determines that any of the general-purpose parameters is applied.

次に、上記の構成によるロボットシステム10の作動について説明する。
(キャリブレーションによるパラメータの取得)
図4に基づいて、ロボットシステム10のキャリブレーションについて説明する。
キャリブレーションが開始されると、制御部31はまず専用パラメータ取得部36によって専用パラメータの取得を実行する。専用パラメータ取得部36は、キャリブレーションの対象となるアプリケーションを決定する(S101)。キャリブレーションの対象となるアプリケーションは、パソコン14から入力されたロボット11の動作プログラムによって決定される。アプリケーションが決定すると、専用パラメータ取得部36は動作エリアを決定する(S102)。動作エリアは、アプリケーションごとに一つ以上設定されている。専用パラメータ取得部36は、その動作エリアからキャリブレーションを実行する動作エリアを決定する。
Next, the operation of the robot system 10 having the above configuration will be described.
(Acquiring parameters by calibration)
Based on FIG. 4, the calibration of the robot system 10 will be described.
When calibration is started, the control unit 31 first acquires a dedicated parameter by the dedicated parameter acquisition unit 36. The dedicated parameter acquisition unit 36 determines an application to be calibrated (S101). The application to be calibrated is determined by the operation program of the robot 11 input from the personal computer 14. When the application is determined, the dedicated parameter acquisition unit 36 determines the operation area (S102). One or more operation areas are set for each application. The dedicated parameter acquisition unit 36 determines an operation area for executing calibration from the operation area.

動作エリアが決定されると、専用パラメータ取得部36はキャリブレーションの位置および姿勢を決定する(S103)。専用パラメータ取得部36は、キャリブレーションの位置および姿勢が決定すると、ロボット11のDHパラメータを保存する(S104)。専用パラメータ取得部36は、キャリブレーションの位置および姿勢が決定したとき、ロボット11のサーボモータ15、アーム16やエンドエフェクタ17の位置など、ロボット11の初期位置となるDHパラメータを取得する。専用パラメータ取得部36は、取得したDHパラメータを記憶部34に記憶する。   When the operation area is determined, the dedicated parameter acquisition unit 36 determines the calibration position and orientation (S103). When the calibration position and orientation are determined, the dedicated parameter acquisition unit 36 stores the DH parameters of the robot 11 (S104). When the calibration position and orientation are determined, the dedicated parameter acquisition unit 36 acquires DH parameters that are initial positions of the robot 11 such as the positions of the servo motor 15, the arm 16, and the end effector 17 of the robot 11. The dedicated parameter acquisition unit 36 stores the acquired DH parameter in the storage unit 34.

初期位置におけるロボット11のDHパラメータが取得されると、専用パラメータ取得部36はロボット11を計測対象となる計測位置に動作させる(S105)。ロボット11は、専用パラメータ取得部36からの制御信号にしたがって計測位置に動作する。ロボット11が計測対象となる計測位置に移動すると、専用パラメータ取得部36は計測位置におけるロボット11の位置および姿勢を取得する(S106)。計測位置におけるロボット11の位置および姿勢は、図示しない外部機器によって取得される。すなわち、計測位置におけるロボット11の位置および姿勢とは、外部機器によって取得された実位置および実姿勢である。外部機器としては、例えばレーザ変位計などの各種の計測機器が適用される。専用パラメータ取得部36は、図示しない外部機器によって取得された実位置および実姿勢を、記憶部34に記憶する。また、専用パラメータ取得部36は、ロボット11を計測対象となる計測位置へ動作させるときに出力した指令位置および姿勢もしくは指令角度を記憶部に記憶する(S107)。   When the DH parameter of the robot 11 at the initial position is acquired, the dedicated parameter acquisition unit 36 moves the robot 11 to the measurement position to be measured (S105). The robot 11 moves to the measurement position according to a control signal from the dedicated parameter acquisition unit 36. When the robot 11 moves to the measurement position to be measured, the dedicated parameter acquisition unit 36 acquires the position and orientation of the robot 11 at the measurement position (S106). The position and posture of the robot 11 at the measurement position are acquired by an external device (not shown). That is, the position and posture of the robot 11 at the measurement position are the actual position and the actual posture acquired by the external device. As the external device, for example, various measuring devices such as a laser displacement meter are applied. The dedicated parameter acquisition unit 36 stores the actual position and actual posture acquired by an external device (not shown) in the storage unit 34. Further, the dedicated parameter acquisition unit 36 stores the command position and orientation or command angle output when the robot 11 is moved to the measurement position to be measured in the storage unit (S107).

専用パラメータ取得部36は、ステップS106におけるロボット11の実位置および実姿勢の取得および記憶、ならびにステップS107における指令位置および姿勢もしくは指令角度の取得および記憶が完了すると、キャリブレーション動作が完了したか否かを判定する(S108)。キャリブレーションは、ステップS103で決定されたキャリブレーション位置および姿勢について複数の計測点において実行される。そのため、専用パラメータ取得部36は、キャリブレーション動作が完了するまでステップS105にリターンして各計測点におけるキャリブレーション動作を繰り返す。   When the acquisition and storage of the actual position and actual posture of the robot 11 in step S106 and the acquisition and storage of the command position, posture, or command angle in step S107 are completed, the dedicated parameter acquisition unit 36 completes the calibration operation. Is determined (S108). Calibration is executed at a plurality of measurement points with respect to the calibration position and orientation determined in step S103. Therefore, the dedicated parameter acquisition unit 36 returns to step S105 until the calibration operation is completed, and repeats the calibration operation at each measurement point.

専用パラメータ取得部36は、ステップS108においてキャリブレーション動作が完了、すなわち各計測点におけるキャリブレーション動作が完了したと判断すると、キャリブレーションを実行し、キャリブレーションデータを作成する(S109)。キャリブレーションデータは、ステップS104で取得したDHパラメータ、ステップS106で取得した計測位置におけるロボット11の実位置および実姿勢、ならびにステップS107で取得した計測位置におけるロボット11への指令位置および姿勢もしくは指令角度に基づく演算によって算出される。専用パラメータ取得部36は、ステップS109で算出したキャリブレーションデータを記憶部34に記憶する(S110)。このとき、専用パラメータ取得部36は、アプリケーションの動作ごと、およびアプリケーションの動作領域ごとにキャリブレーションデータを作成し、記憶部34に記憶する。   When the dedicated parameter acquisition unit 36 determines in step S108 that the calibration operation has been completed, that is, the calibration operation at each measurement point has been completed, the dedicated parameter acquisition unit 36 performs calibration and creates calibration data (S109). The calibration data includes the DH parameter acquired in step S104, the actual position and posture of the robot 11 at the measurement position acquired in step S106, and the command position and posture or command angle to the robot 11 at the measurement position acquired in step S107. It is calculated by the calculation based on The dedicated parameter acquisition unit 36 stores the calibration data calculated in step S109 in the storage unit 34 (S110). At this time, the dedicated parameter acquisition unit 36 creates calibration data for each operation of the application and each operation region of the application, and stores the calibration data in the storage unit 34.

専用パラメータ取得部36は、アプリケーションの別の動作領域においてキャリブレーションデータを作成するか否かを判断する(S111)。専用パラメータ取得部36は、別の動作領域においてキャリブレーションデータを作成する必要があると判断すると、ステップS102へリターンし、ステップS103からステップS110の処理を繰り返す。
専用パラメータ取得部36は、アプリケーションの各領域におけるキャリブレーションデータの作成が完了したと判断すると、別のアプリケーションにおけるキャリブレーションデータを作成するか否かを判断する(S112)。専用パラメータ取得部36は、別のアプリケーションについてキャリブレーションデータを作成する必要があると判断すると、S101へリターンし、ステップS102からステップS111の処理を繰り返す。
The dedicated parameter acquisition unit 36 determines whether to create calibration data in another operation region of the application (S111). When the dedicated parameter acquisition unit 36 determines that it is necessary to create calibration data in another operation region, the process returns to step S102 and repeats the processing from step S103 to step S110.
When the dedicated parameter acquisition unit 36 determines that the creation of calibration data in each area of the application is complete, it determines whether to create calibration data in another application (S112). If the dedicated parameter acquisition unit 36 determines that it is necessary to create calibration data for another application, it returns to S101 and repeats the processing from step S102 to step S111.

以上のように、ロボット11に設定されているアプリケーションのすべての動作領域においてステップS101からステップS112の処理を実行することにより、専用パラメータ取得部36は、ロボット11の特定領域における特定動作について専用のキャリブレーションデータを作成する。そして、専用パラメータ取得部36は、作成したキャリブレーションデータに基づき専用パラメータを取得する。専用パラメータ取得部36は、取得した専用パラメータを記憶部34に記憶する。
制御部31は、専用パラメータ取得部36によるステップS101からステップS112の処理が完了すると、汎用パラメータ取得部35による汎用パラメータの取得に移行する。汎用パラメータ取得部35は、まず汎用キャリブレーション位置および姿勢を決定する(S113)。ここで、汎用キャリブレーション位置とは、ロボット11のすべての動作領域におけるすべての動作に対象とするキャリブレーションが実行されるロボット11の代表的な位置および姿勢である。
As described above, by executing the processing from step S101 to step S112 in all operation regions of the application set in the robot 11, the dedicated parameter acquisition unit 36 is dedicated to the specific operation in the specific region of the robot 11. Create calibration data. Then, the dedicated parameter acquisition unit 36 acquires a dedicated parameter based on the created calibration data. The dedicated parameter acquisition unit 36 stores the acquired dedicated parameter in the storage unit 34.
When the processing from step S101 to step S112 by the dedicated parameter acquisition unit 36 is completed, the control unit 31 proceeds to acquisition of a general parameter by the general parameter acquisition unit 35. The general-purpose parameter acquisition unit 35 first determines a general-purpose calibration position and orientation (S113). Here, the general-purpose calibration position is a representative position and posture of the robot 11 where calibration is performed for all motions in all motion regions of the robot 11.

汎用パラメータ取得部35は、汎用キャリブレーション位置および姿勢を決定すると、ロボット11の計測対象となる計測位置へ動作させる(S114)。ロボット11は、汎用パラメータ取得部35からの制御信号にしたがって計測位置に動作する。ロボット11が計測対象となる計測位置に移動すると、汎用パラメータ取得部35は計測位置におけるロボット11の位置および姿勢を取得する(S115)。計測位置におけるロボット11の位置および姿勢は、図示しない外部機器によって取得される。すなわち、計測位置におけるロボット11の位置および姿勢とは、例えばレーザ変位計などの各種の計測機器からなる外部機器によって取得された実位置および実姿勢である。汎用パラメータ取得部35は、取得した実位置および実姿勢を記憶部34に記憶する。また、汎用パラメータ取得部35は、ロボット11を計測対象となる計測位置へ動作させるときに出力した指令位置および姿勢もしくは指令角度を記憶部34に記憶する(S116)。   When the general-purpose parameter acquisition unit 35 determines the general-purpose calibration position and orientation, the general-purpose parameter acquisition unit 35 operates the measurement position to be measured by the robot 11 (S114). The robot 11 moves to the measurement position according to the control signal from the general parameter acquisition unit 35. When the robot 11 moves to the measurement position to be measured, the general-purpose parameter acquisition unit 35 acquires the position and orientation of the robot 11 at the measurement position (S115). The position and posture of the robot 11 at the measurement position are acquired by an external device (not shown). That is, the position and orientation of the robot 11 at the measurement position are the actual position and orientation acquired by an external device including various measurement devices such as a laser displacement meter. The general-purpose parameter acquisition unit 35 stores the acquired actual position and actual posture in the storage unit 34. The general-purpose parameter acquisition unit 35 stores the command position and orientation or command angle output when the robot 11 is moved to the measurement position to be measured in the storage unit 34 (S116).

汎用パラメータ取得部35は、ステップS115におけるロボット11の実位置および実姿勢の取得および記憶、ならびにステップS116における指令位置および姿勢もしくは指令角度の取得および記憶が完了すると、キャリブレーション動作が完了したか否かを判定する(S117)。キャリブレーションは、ステップS113で決定されたキャリブレーション位置および姿勢について複数の計測点において実行される。そのため、汎用パラメータ取得部35は、キャリブレーション動作が完了するまでステップS114にリターンして各計測点におけるキャリブレーション動作を繰り返す。   When the acquisition and storage of the actual position and actual posture of the robot 11 in step S115 and the acquisition and storage of the command position, posture, and command angle in step S116 are completed, the general-purpose parameter acquisition unit 35 determines whether the calibration operation is completed. Is determined (S117). Calibration is performed at a plurality of measurement points with respect to the calibration position and orientation determined in step S113. Therefore, the general-purpose parameter acquisition unit 35 returns to step S114 until the calibration operation is completed, and repeats the calibration operation at each measurement point.

汎用パラメータ取得部35は、ステップS117においてキャリブレーション動作が完了、すなわち各計測点におけるキャリブレーション動作が完了したと判断すると、キャリブレーションを実行し、キャリブレーションデータを作成する(S118)。キャリブレーションデータは、ステップS115で取得した計測位置におけるロボット11の実位置および実姿勢、ならびにステップS116で取得した計測位置におけるロボット11への指令位置および姿勢もしくは指令角度に基づく演算によって算出される。汎用パラメータ取得部35は、ステップS1018で算出したキャリブレーションデータを記憶部34に記憶する(S119)。このとき、汎用パラメータ取得部35は、ロボット11のすべての動作領域におけるすべての動作に適用可能なキャリブレーションデータを作成し、記憶部34に記憶する。   If the general-purpose parameter acquisition unit 35 determines in step S117 that the calibration operation is completed, that is, the calibration operation at each measurement point is completed, the general-purpose parameter acquisition unit 35 executes calibration and creates calibration data (S118). The calibration data is calculated by calculation based on the actual position and actual posture of the robot 11 at the measurement position acquired in step S115 and the command position and posture or command angle to the robot 11 at the measurement position acquired in step S116. The general-purpose parameter acquisition unit 35 stores the calibration data calculated in step S1018 in the storage unit 34 (S119). At this time, the general-purpose parameter acquisition unit 35 creates calibration data applicable to all operations in all operation regions of the robot 11 and stores the calibration data in the storage unit 34.

以上のように、ステップS113からステップS119の処理を実行することにより、汎用パラメータ取得部35は、ロボット11のすべての動作領域におけるすべての動作についての基礎となるキャリブレーションデータを作成する。そして、汎用パラメータ取得部35は、作成したキャリブレーションデータに基づき汎用パラメータを取得する。汎用パラメータ取得部35は、取得した汎用パラメータを記憶部34に記憶する。   As described above, by executing the processing from step S113 to step S119, the general-purpose parameter acquisition unit 35 creates calibration data that is the basis for all operations in all operation regions of the robot 11. Then, the general parameter acquisition unit 35 acquires a general parameter based on the created calibration data. The general-purpose parameter acquisition unit 35 stores the acquired general-purpose parameter in the storage unit 34.

(パラメータの適用)
制御部31は、上述の図4に示す流れによって取得した専用パラメータおよび汎用パラメータを用いてロボット11の動作を制御する。以下、図5に基づいてパラメータの選択およびパラメータの適用について説明する。
ロボット11を動作させるとき、ユーザはロボット11に適用する動作プログラムを入力する(S201)。動作プログラムは、例えばパソコン14から制御装置12に入力される。制御装置12には、複数の動作プログラムが入力される場合がある。そのため、複数の動作プログラムのうち、制御装置12で選択されてロボット11で実行されるプログラムが特許請求の範囲の実行プログラムに相当する。
(Applying parameters)
The control unit 31 controls the operation of the robot 11 using the dedicated parameter and the general-purpose parameter acquired by the flow shown in FIG. The parameter selection and parameter application will be described below with reference to FIG.
When operating the robot 11, the user inputs an operation program to be applied to the robot 11 (S201). The operation program is input from the personal computer 14 to the control device 12, for example. A plurality of operation programs may be input to the control device 12. Therefore, the program selected by the control device 12 and executed by the robot 11 among the plurality of operation programs corresponds to the execution program of the claims.

判断部37は、入力された動作プログラムのうちロボット11で実行される実行プログラムを解析する(S202)。判断部37および動作制御調整部38は、協働して実行プログラムが専用パラメータを適用すべきものか、汎用プログラムを適用すべきものかを判断する。具体的には、判断部37は、実行プログラムに特定動作が含まれているか否かを判断する(S203)。すなわち、判断部37は、実行プログラムに特定動作をともなうアプリケーションが含まれているか否かを判断する。判断部37は、実行プログラムに特定動作をともなうアプリケーションが含まれていると判断すると、特定領域内での動作であるか否かを判断する(S204)。すなわち、判断部37は、実行プログラムにしたがうロボット11の動作が特定領域で動作するものか否かを判断する。   The determination unit 37 analyzes an execution program executed by the robot 11 among the input operation programs (S202). The determination unit 37 and the operation control adjustment unit 38 cooperate to determine whether the execution program should apply a dedicated parameter or a general-purpose program. Specifically, the determination unit 37 determines whether a specific operation is included in the execution program (S203). That is, the determination unit 37 determines whether an application with a specific operation is included in the execution program. When determining that the execution program includes an application with a specific operation, the determination unit 37 determines whether the operation is within a specific area (S204). That is, the determination unit 37 determines whether or not the operation of the robot 11 according to the execution program is an operation in a specific area.

動作制御調整部38は、ステップS203において実行プログラムがロボット11の特定動作をともなうアプリケーションを含み、かつステップS204においてロボット11の動作が特定領域内であると判断すると、記憶部34から専用パラメータを読み取る(S205)。一方、動作制御調整部38は、ステップS203において実行プログラムがロボット11の特定動作をともなうアプリケーションを含まない、またはステップS204においてロボット11の動作が特定領域外であると判断すると、記憶部34から汎用パラメータを読み取る(S206)。   If the execution program includes an application with a specific operation of the robot 11 in step S203 and the operation of the robot 11 is determined to be in the specific area in step S204, the operation control adjustment unit 38 reads the dedicated parameter from the storage unit 34. (S205). On the other hand, when the operation control adjustment unit 38 determines in step S203 that the execution program does not include an application with the specific operation of the robot 11 or in step S204 that the operation of the robot 11 is outside the specific region, the operation control adjustment unit 38 reads the general-purpose information from the storage unit 34. The parameter is read (S206).

動作制御調整部38は、ステップS205において専用パラメータを読み取る、またはステップS206において汎用パラメータを読み取ると、読み取った専用パラメータまたは汎用パラメータを適用して補正値を計算する(S207)。すなわち、動作制御調整部38は、ステップS205において専用パラメータを読み取ると、ロボット11の制御に専用パラメータを適用する。一方、動作制御調整部38は、ステップS206において汎用パラメータを読み取ると、ロボット11の制御に汎用パラメータを適用する。   When the operation control adjustment unit 38 reads the dedicated parameter in step S205 or reads the general parameter in step S206, the operation control adjustment unit 38 applies the read dedicated parameter or general parameter to calculate the correction value (S207). That is, when the operation control adjustment unit 38 reads the dedicated parameter in step S205, the operation control adjustment unit 38 applies the dedicated parameter to the control of the robot 11. On the other hand, when the operation control adjustment unit 38 reads the general parameter in step S206, the operation control adjustment unit 38 applies the general parameter to the control of the robot 11.

制御部31は、ステップS207で計算された補正値を適用して実行プログラムを実行し、ロボット11を制御する(S208)。以上のように、制御装置12は、実行プログラムにしたがうロボット11の動作が特定領域における特定動作を含むとき、専用パラメータを適用してロボット11を制御する。一方、制御装置12は、実行プログラムにしたがうロボット11の動作が特定領域における特定動作を含まないとき、汎用パラメータを適用してロボット11を制御する。   The control unit 31 executes the execution program by applying the correction value calculated in step S207, and controls the robot 11 (S208). As described above, when the operation of the robot 11 according to the execution program includes a specific operation in a specific area, the control device 12 controls the robot 11 by applying a dedicated parameter. On the other hand, when the operation of the robot 11 according to the execution program does not include the specific operation in the specific region, the control device 12 controls the robot 11 by applying general-purpose parameters.

以上説明した本発明の一実施形態では、ロボット11の動作領域および動作に応じて専用パラメータまたは汎用パラメータを適用してロボット11を制御している。例えば非常に高い精度が要求される限られた領域における限られた動作となる専用性が高い動作をロボット11で実行する場合、ロボット11の可動領域の全体に適用可能な汎用パラメータを適用してロボット11を制御すると、この微少な領域における微少な動作の精度確保が困難になりやすい。一方、この微少な領域における微少な動作の精度をロボット11の可動領域全体に適用すると、ロボット11の動作の補正に適用するためのデータが膨大となる。そこで、本発明の一実施形態では、ロボット11の動作を規定する実行プログラムに含まれるアプリケーションが特定領域における特定動作であるときに限り専用パラメータを適用してロボット11を制御し、その他の領域および動作では汎用パラメータを適用してロボット11を制御している。そのため、ロボット11が特定領域における特定動作であるとき、高い精度が確保される専用パラメータを適用してロボット11を制御し、その他の領域および動作ではデータ量の小さな汎用パラメータを適用してロボット11を制御している。したがって、ロボット11の可動領域全体での各種動作における精度の確保と、ロボット11の特定領域における特定動作における精度の確保とを両立して達成することができる。   In the embodiment of the present invention described above, the robot 11 is controlled by applying a dedicated parameter or a general-purpose parameter in accordance with the motion region and motion of the robot 11. For example, in the case where the robot 11 performs a highly dedicated motion that is a limited motion in a limited region where very high accuracy is required, a general-purpose parameter that can be applied to the entire movable region of the robot 11 is applied. When the robot 11 is controlled, it is difficult to ensure the accuracy of minute operations in this minute region. On the other hand, if the accuracy of the minute operation in this minute region is applied to the entire movable region of the robot 11, data to be applied to the correction of the operation of the robot 11 becomes enormous. Therefore, in one embodiment of the present invention, the dedicated parameter is applied to control the robot 11 only when the application included in the execution program that defines the operation of the robot 11 is a specific operation in the specific region, In operation, the robot 11 is controlled by applying general-purpose parameters. Therefore, when the robot 11 performs a specific operation in a specific area, the robot 11 is controlled by applying a dedicated parameter that ensures high accuracy, and in the other areas and operations, a general-purpose parameter with a small amount of data is applied. Is controlling. Accordingly, it is possible to achieve both ensuring accuracy in various operations in the entire movable region of the robot 11 and ensuring accuracy in specific operations in the specific region of the robot 11.

(その他の実施形態)
制御部31は、ロボット11が起動時にある場合、上記の図5に示す判断に基づくことなく、汎用パラメータを適用してロボット11を制御してもよい。ロボット11は、起動と同時あるいは起動直後に精密な特定領域における特定動作を実行することはほとんどない。そのため、ロボット11が起動時にある場合、制御部31は汎用パラメータを適用してロボット11を制御する。したがって、起動に要する時間を短縮することができる。
(Other embodiments)
The control unit 31 may control the robot 11 by applying general-purpose parameters without being based on the determination shown in FIG. The robot 11 hardly performs a specific operation in a specific specific area simultaneously with the start or immediately after the start. Therefore, when the robot 11 is activated, the control unit 31 controls the robot 11 by applying general-purpose parameters. Therefore, the time required for activation can be shortened.

ところで、ロボット11は、その動作によっては特定領域外における任意の動作から特定領域における特定動作に移行する場合がある。このとき、制御装置12は、ロボット11の動作が一つのステップを完了した後に、図5に示すステップS207におけるパラメータの適用を切り替える構成としてもよい。すなわち、制御装置12は、ロボット11の動作が一連して継続している途中で専用パラメータと汎用パラメータとを切り替えない。専用パラメータを適用してロボット11を制御するときと、汎用パラメータを適用してロボット11を制御するときとでは、動作にずれあるいは誤差が生じるおそれがある。例えば特定領域外から特定領域における特定動作に移行するとき、パラメータを切り替えると、ロボット11が特定領域外から特定領域に移動した際に制御精度は変化する。その結果、ロボット11の位置や角度にわずかなずれが生じるおそれがある。そこで、制御装置12は、ロボット11の動作が専用パラメータを適用する条件から汎用パラメータを適用する条件へ移行するとき、およびその逆に移行するとき、ロボット11の動作が一つのステップを完了するまでパラメータの切り替えを行わない。すなわち、制御装置12は、ロボット11が一連の動作を行っているとき、その動作が完了するまでパラメータを切り替えない。したがって、ロボット11の動作中における動作のずれを低減することができる。   Incidentally, the robot 11 may shift from an arbitrary operation outside the specific region to a specific operation in the specific region depending on its operation. At this time, after the operation of the robot 11 completes one step, the control device 12 may be configured to switch application of parameters in step S207 shown in FIG. That is, the control device 12 does not switch between the dedicated parameter and the general-purpose parameter while the operation of the robot 11 is continuously performed. There is a possibility that a deviation or an error occurs in the operation when the robot 11 is controlled by applying the dedicated parameter and when the robot 11 is controlled by applying the general-purpose parameter. For example, when shifting from a specific area to a specific operation in the specific area, if the parameters are switched, the control accuracy changes when the robot 11 moves from the specific area to the specific area. As a result, there may be a slight shift in the position and angle of the robot 11. Therefore, when the operation of the robot 11 shifts from the condition for applying the dedicated parameter to the condition for applying the general-purpose parameter and vice versa, the operation of the robot 11 completes one step. Do not switch parameters. That is, when the robot 11 performs a series of operations, the control device 12 does not switch parameters until the operations are completed. Accordingly, it is possible to reduce the deviation of the operation during the operation of the robot 11.

本発明の一実施形態によるロボットシステムの概略を示すブロック図The block diagram which shows the outline of the robot system by one Embodiment of this invention 本発明の一実施形態によるロボットシステムの構成を示す概略図Schematic which shows the structure of the robot system by one Embodiment of this invention. 本発明の一実施形態によるロボットシステムにおいて、動作領域および動作とパラメータとの関係を示す概略図FIG. 3 is a schematic diagram showing a motion region and a relationship between motion and parameters in the robot system according to the embodiment of the present invention. 本発明の一実施形態によるロボットシステムによるキャリブレーションの流れを示す概略図Schematic showing a flow of calibration by a robot system according to an embodiment of the present invention. 本発明の一実施形態によるロボットシステムによるパラメータの選択および適用の流れを示す概略図Schematic showing the flow of parameter selection and application by a robot system according to an embodiment of the present invention.

符号の説明Explanation of symbols

図面中、11はロボット、12は制御装置(ロボット制御装置)、34は記憶部(記憶手段)、35は汎用パラメータ取得部(汎用パラメータ取得手段)、36は専用パラメータ取得部(専用パラメータ取得手段)、37は判断部(判断手段)、38は動作制御調整部(動作制御調整手段)を示す。   In the drawings, 11 is a robot, 12 is a control device (robot control device), 34 is a storage unit (storage unit), 35 is a general-purpose parameter acquisition unit (general-purpose parameter acquisition unit), and 36 is a dedicated parameter acquisition unit (dedicated parameter acquisition unit). , 37 indicates a determination unit (determination unit), and 38 indicates an operation control adjustment unit (operation control adjustment unit).

Claims (1)

ロボットの動作単位で設定されたプログラムにしたがって、前記ロボットの動作を制御するロボット制御装置であって、
前記ロボットの可動領域全体からまんべんなく選ばれた目的点および各種動作についてのキャリブレーションを実行して、想定される可動領域全体において想定される各種動作に適用可能であって前記ロボットの制御の基礎となる汎用パラメータを取得する汎用パラメータ取得手段と、
前記ロボットの前記可動領域の一部に設定された特定領域における動作において、前記ロボットが可能な動作のうちの一部に設定された特定動作についてのキャリブレーションを実行して、前記特定領域かつ前記特定動作に専用の専用パラメータを取得する専用パラメータ取得手段と、
前記汎用パラメータ取得手段で取得した汎用パラメータ、および前記専用パラメータ取得手段で取得した専用パラメータを記憶する記憶手段と、
実行される実行プログラムに基づく前記ロボットの動作が、前記特定領域における前記特定動作であるか否かを判断する判断手段と、
前記判断手段において前記ロボットの動作が前記特定領域における前記特定動作であると判断すると前記記憶手段に記憶されている前記専用パラメータを適用して前記ロボットの動作を制御し、前記判断手段において前記ロボットの動作が前記特定領域における前記特定動作でないと判断すると前記記憶手段に記憶されている前記汎用パラメータを適用して前記ロボットの動作を制御する動作制御調整手段と、を備え、
前記動作制御調整手段は、前記ロボットにおいて一つのステップにおける動作が停止した後、前記汎用パラメータによる動作の制御と前記専用パラメータによる動作の制御とを切り替えることを特徴とするロボット制御装置。
A robot control device for controlling the operation of the robot according to a program set in a robot operation unit,
It is applicable to various assumed motions in the entire assumed movable region by executing calibration for the target points and various motions uniformly selected from the entire movable region of the robot. A general parameter acquisition means for acquiring a general parameter,
In an operation in a specific area set as a part of the movable area of the robot, calibration is performed for a specific action set as a part of the actions that the robot can perform, and the specific area and the A dedicated parameter acquisition means for acquiring a dedicated parameter dedicated to a specific operation;
Storage means for storing the general parameters acquired by the general parameter acquisition means, and the dedicated parameters acquired by the dedicated parameter acquisition means;
Determining means for determining whether or not the operation of the robot based on the execution program to be executed is the specific operation in the specific region;
When the determination means determines that the robot motion is the specific motion in the specific area, the robot controls the robot operation by applying the dedicated parameter stored in the storage means. An operation control adjusting unit that controls the operation of the robot by applying the general-purpose parameter stored in the storage unit when it is determined that the operation is not the specific operation in the specific region ,
The robot control apparatus, wherein the motion control adjusting unit switches between motion control using the general-purpose parameter and motion control based on the dedicated parameter after the robot stops motion in one step .
JP2007319554A 2007-12-11 2007-12-11 Robot controller Expired - Fee Related JP4882990B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2007319554A JP4882990B2 (en) 2007-12-11 2007-12-11 Robot controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2007319554A JP4882990B2 (en) 2007-12-11 2007-12-11 Robot controller

Publications (2)

Publication Number Publication Date
JP2009142903A JP2009142903A (en) 2009-07-02
JP4882990B2 true JP4882990B2 (en) 2012-02-22

Family

ID=40914150

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2007319554A Expired - Fee Related JP4882990B2 (en) 2007-12-11 2007-12-11 Robot controller

Country Status (1)

Country Link
JP (1) JP4882990B2 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016159367A (en) 2015-02-26 2016-09-05 ファナック株式会社 Robot controller that automatically switches the operation mode of the robot
WO2023013739A1 (en) * 2021-08-04 2023-02-09 京セラ株式会社 Robot control device, robot control system, and robot control method

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2527861B2 (en) * 1991-09-25 1996-08-28 日本碍子株式会社 Drying method for thick ceramic products
JP2923713B2 (en) * 1992-02-27 1999-07-26 新明和工業株式会社 Drive control method for cylindrical coordinate robot
JPH06304893A (en) * 1993-04-22 1994-11-01 Fanuc Ltd Calibration system for positioning mechanism
JPH07200017A (en) * 1994-01-10 1995-08-04 Hitachi Ltd Robot mechanical error correction method
JP2003148914A (en) * 2001-11-08 2003-05-21 Fanuc Ltd Position detector and taking-out device using position detection
JP3660332B2 (en) * 2002-08-29 2005-06-15 独立行政法人科学技術振興機構 Walking / running control method for legged mobile device and walking / running control device for legged mobile device

Also Published As

Publication number Publication date
JP2009142903A (en) 2009-07-02

Similar Documents

Publication Publication Date Title
JP7339806B2 (en) Control system, robot system and control method
CN110997249B (en) Work robot and control method of work robot
JP6782240B2 (en) Robot system
US9149931B2 (en) Robot system, robot control device and method for controlling robot
JP6619395B2 (en) Robot system and robot teaching method
JP5743495B2 (en) Robot controller
JP2014128845A (en) Robot system display device
KR101010761B1 (en) Robot control device with robot body and additional mechanism with additional axis of motion
JP6859757B2 (en) Control system, setting device, setting method, and setting program
US11833687B2 (en) Robot apparatus, control method for the robot apparatus, assembly method using the robot apparatus, and recording medium
US10569418B2 (en) Robot controller for executing calibration, measurement system and calibration method
WO2020027105A1 (en) Robot system
JP5447048B2 (en) Robot control apparatus and robot position correction control method
US20080303473A1 (en) Robot control apparatus
JP5011507B2 (en) Robot teaching system and robot teaching method
JP4882990B2 (en) Robot controller
JP7512743B2 (en) Teaching method and robot system
JP5245384B2 (en) Robot controller
KR20150086161A (en) Robot, robot control method and robot control program
Kim et al. An augmented reality-based wearable system for handheld-free and intuitive robot programming
JP4951783B2 (en) Robot control apparatus and robot control method
WO2016162066A1 (en) An industrial robot and a method for lead-through programming of an industrial robot
KR20150044241A (en) Apparatus for teaching of robot pose Pendant Equipped Slide-out
KR101474778B1 (en) Control device using motion recognition in artculated robot and method thereof
US20190389052A1 (en) Control apparatus, robot, and robot system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20100111

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20110523

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110531

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20110720

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

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20111121

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20141216

Year of fee payment: 3

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

Ref document number: 4882990

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20141216

Year of fee payment: 3

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees