[go: up one dir, main page]

JP2017094458A - Robot moving locus drawing apparatus - Google Patents

Robot moving locus drawing apparatus Download PDF

Info

Publication number
JP2017094458A
JP2017094458A JP2015230058A JP2015230058A JP2017094458A JP 2017094458 A JP2017094458 A JP 2017094458A JP 2015230058 A JP2015230058 A JP 2015230058A JP 2015230058 A JP2015230058 A JP 2015230058A JP 2017094458 A JP2017094458 A JP 2017094458A
Authority
JP
Japan
Prior art keywords
cycle
robot
point
component
previous
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP2015230058A
Other languages
Japanese (ja)
Inventor
喜浩 宮越
Yoshihiro Miyakoshi
喜浩 宮越
基希 金田
Motoki Kaneda
基希 金田
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 JP2015230058A priority Critical patent/JP2017094458A/en
Publication of JP2017094458A publication Critical patent/JP2017094458A/en
Pending legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)

Abstract

PROBLEM TO BE SOLVED: To suppress deviation between the actual moving locus of a robot and a moving locus to be drawn while suppressing an increase in processing load.SOLUTION: A drawing apparatus 50 that draws the moving locus of a robot 20 at a drawing period longer than a control period on a display unit 51 on the basis of a signal from a controller 30 that controls the robot 20 at the prescribed control period acquires information indicating the position of the robot 20 at a predetermined point at each control period from the controller 30, determines, on the basis of the acquired information, whether the drawing period includes an extreme value point at which at least one component at the position on a coordinate system takes an extreme value with respect to time, when it is determined that the extreme value point is not included, draws a moving locus connecting the position during the previous drawing period and the position during the current drawing period on the display unit 51, and when it is determined that the extreme value point is included, a moving locus for connection from the position during the previous drawing period to the position during the current drawing period closer to the extreme value point on the display unit 51.SELECTED DRAWING: Figure 1

Description

本発明は、ロボットの移動軌跡を表示部に描画する装置に関する。   The present invention relates to an apparatus for drawing a movement locus of a robot on a display unit.

従来、教示目標点のうち最初の所定個数の教示目標点を取得し、ロボットの初期位置の座標から、取得した最後の教示目標点までの移動軌跡を表示部に描画するものがある(特許文献1参照)。   2. Description of the Related Art Conventionally, there is a technique in which a first predetermined number of teaching target points are acquired from teaching target points, and a movement locus from the initial position coordinates of the robot to the acquired last teaching target point is drawn on a display unit (Patent Document). 1).

特許第5375436号公報Japanese Patent No. 5375436

ところで、ロボットの移動軌跡を正確に描画するためには、描画点と描画点とを結ぶ線を描く描画周期をできるだけ短くすることが望ましい。しかしながら、移動軌跡を描画する処理負荷の問題から、ロボットの制御周期よりもかなり長い描画周期で移動軌跡を描画することが一般的である。このため、描画点と描画点との距離がかなり長くなり、ロボットの実際の移動軌跡と描画された移動軌跡とのずれが大きくなっている。   By the way, in order to accurately draw the movement trajectory of the robot, it is desirable to make the drawing cycle for drawing a line connecting the drawing points as short as possible. However, due to the problem of the processing load for drawing the movement trajectory, it is common to draw the movement trajectory with a drawing cycle much longer than the control cycle of the robot. For this reason, the distance between the drawing points is considerably long, and the deviation between the actual movement locus of the robot and the drawn movement locus is large.

本発明は、こうした実情に鑑みてなされたものであり、その主たる目的は、移動軌跡を描画する処理負荷の増大を抑制しつつ、ロボットの実際の移動軌跡と描画される移動軌跡とのずれを抑制することのできるロボットの移動軌跡描画装置を提供することにある。   The present invention has been made in view of such circumstances, and the main purpose thereof is to suppress the shift between the actual movement locus of the robot and the drawn movement locus while suppressing an increase in the processing load for drawing the movement locus. It is an object of the present invention to provide a robot movement trajectory drawing apparatus that can be suppressed.

本発明は、上記課題を解決するために、以下の手段を採用した。   The present invention employs the following means in order to solve the above problems.

第1の手段は、ロボットを所定の制御周期で制御する制御部からの信号に基づいて、前記制御周期よりも長い描画周期で前記ロボットの移動軌跡を表示部に描画する描画装置であって、前記制御部から各制御周期における前記ロボットの所定点の位置を表す情報を取得する取得部と、前記取得部により取得された前記情報に基づいて、時間に対して座標系における前記位置の少なくとも1つの成分が極値になる極値点を、前記描画周期内に含むか否かを判定する判定部と、前記判定部により前記極値点を含まないと判定された場合に、前回の描画周期における前記位置と今回の描画周期における前記位置とを結ぶ前記移動軌跡を前記表示部に描画し、前記判定部により前記極値点を含むと判定された場合に、前回の描画周期における前記位置から前記極値点に寄って今回の描画周期における前記位置へ結ぶ前記移動軌跡を前記表示部に描画する描画部と、を備えることを特徴とする。   The first means is a drawing apparatus that draws the movement locus of the robot on the display unit at a drawing cycle longer than the control cycle based on a signal from a control unit that controls the robot at a predetermined control cycle. An acquisition unit that acquires information representing the position of the predetermined point of the robot in each control cycle from the control unit, and at least one of the positions in the coordinate system with respect to time based on the information acquired by the acquisition unit A determination unit that determines whether or not an extreme point in which one component is an extreme value is included in the drawing cycle; and when the determination unit determines that the extreme point is not included, the previous drawing cycle The movement locus connecting the position in the current drawing cycle and the position in the current drawing cycle is drawn on the display unit, and when the determination unit determines that the extreme point is included, the position in the previous drawing cycle Characterized in that it and a drawing unit for drawing the movement locus that connects to the position on the display unit in the current drawing periods displaced in al the extreme point.

上記構成によれば、ロボットを所定の制御周期で制御する制御部からの信号に基づいて、描画装置によって制御周期よりも長い描画周期で描画点と描画点とを結ぶロボットの移動軌跡が表示部に描画される。   According to the above configuration, based on a signal from the control unit that controls the robot at a predetermined control cycle, the movement trajectory of the robot that connects the drawing point and the drawing point at a drawing cycle longer than the control cycle by the drawing device is displayed on the display unit. Drawn on.

ここで、取得部により、制御部から各制御周期におけるロボットの所定点の位置を表す情報が取得される。そして、判定部によって、取得部により取得された情報に基づいて、時間に対して座標系における前記位置の少なくとも1つの成分が極値になる極値点を、描画周期内に含むか否か判定される。極値点では、座標系の少なくとも1つの成分(例えば、直交座標系のx成分)に関して、所定点が移動する方向が反転するため、移動軌跡の変化が大きくなる。このため、描画周期内に極値点が含まれる場合は、前回の描画周期における所定点の位置(以下「前回位置」という)と今回の描画周期における所定点の位置(以下「今回位置」という)とを結ぶ移動軌跡を描画すると、ロボットの実際の移動軌跡と描画される移動軌跡とのずれが大きくなり易い。   Here, the information indicating the position of the predetermined point of the robot in each control cycle is acquired from the control unit by the acquisition unit. Then, based on the information acquired by the acquisition unit, the determination unit determines whether or not the drawing cycle includes an extreme point where at least one component of the position in the coordinate system with respect to time is an extreme value. Is done. At the extreme point, the direction of movement of the predetermined point is reversed with respect to at least one component of the coordinate system (for example, the x component of the orthogonal coordinate system), so that the movement locus changes greatly. Therefore, when an extreme point is included in the drawing cycle, the position of the predetermined point in the previous drawing cycle (hereinafter referred to as “previous position”) and the position of the predetermined point in the current drawing cycle (hereinafter referred to as “current position”). ) Is drawn, the difference between the actual movement locus of the robot and the drawn movement locus tends to increase.

この点、判定部により極値点を含まないと判定された場合に、前回位置と今回位置とを結ぶ移動軌跡が表示部に描画される。このため、所定点が移動する方向が反転せず、実際の移動軌跡と描画される移動軌跡とがずれにくい場合は、移動軌跡を描画する処理負荷を小さくすることができる。   When the determination unit determines that the extreme point is not included, a movement trajectory connecting the previous position and the current position is drawn on the display unit. For this reason, when the direction in which the predetermined point moves is not reversed and the actual movement locus and the drawn movement locus are difficult to shift, the processing load for drawing the movement locus can be reduced.

これに対して、判定部により極値点を含むと判定された場合に、前回位置から極値点に寄って今回位置へ結ぶ移動軌跡が表示部に描画される。極値点に寄るとは、前回位置から極値点を通過して今回位置へ結ぶことの他、前回位置から極値点近傍の点を通過して今回位置へ結ぶことを含むものとする。このため、所定点が移動する方向が反転し、実際の移動軌跡と描画される移動軌跡とがずれ易い場合は、前回位置と今回位置との間で極値点に寄るように移動軌跡が描画される。したがって、ロボットの実際の移動軌跡と描画される移動軌跡とのずれを抑制することができる。さらに、前回位置と今回位置との間で極値点に寄るだけであるため、移動軌跡を描画する処理負荷の増大を抑制することができる。   On the other hand, when the determination unit determines that an extreme point is included, a movement locus connecting from the previous position to the extreme point is drawn on the display unit. The approach to the extreme point includes not only passing through the extreme point from the previous position and connecting to the current position but also passing through a point near the extreme point from the previous position and connecting to the current position. For this reason, if the direction in which the predetermined point moves is reversed and the actual movement locus is likely to deviate from the drawn movement locus, the movement locus is drawn so as to approach the extreme point between the previous position and the current position. Is done. Therefore, it is possible to suppress a deviation between the actual movement locus of the robot and the drawn movement locus. Furthermore, since only the extreme point is between the previous position and the current position, an increase in processing load for drawing the movement trajectory can be suppressed.

第2の手段では、前記描画部は、前記判定部により前記極値点を含むと判定された場合に、前記描画周期内において前記位置が前記極値点に最も近付く制御周期における前記位置を通過位置に設定し、前回の描画周期における前記位置から前記通過位置を通過して今回の描画周期における前記位置へ結ぶ前記移動軌跡を前記表示部に描画する。   In the second means, the drawing unit passes through the position in the control cycle in which the position is closest to the extreme point within the drawing cycle when the determination unit determines that the extreme point is included. The position is set to the position, and the movement trajectory connecting the position from the position in the previous drawing cycle to the position in the current drawing cycle is drawn on the display unit.

ロボットの所定点の位置が極値点となるタイミングと、制御周期における位置取得タイミングとがずれることがある。この場合、所定点の位置を表す情報に基づいて算出される位置と極値点とがずれることとなる。   The timing at which the position of the predetermined point of the robot becomes an extreme value point may deviate from the position acquisition timing in the control cycle. In this case, the position calculated based on the information indicating the position of the predetermined point and the extreme value point are shifted.

この点、上記構成によれば、判定部により極値点を含むと判定された場合に、描画周期内において前記位置が極値点に最も近付く制御周期における前記位置が通過位置に設定される。そして、前回位置から通過位置を通過して今回位置へ結ぶ移動軌跡が表示部に描画される。したがって、所定点の位置を表す情報に基づいて算出される位置と極値点とがずれる場合であっても、前回位置から極値点に寄って今回位置へ結ぶ移動軌跡を描画することができる。   In this regard, according to the above configuration, when the determination unit determines that an extreme point is included, the position in the control cycle in which the position is closest to the extreme point within the drawing cycle is set as the passing position. Then, a movement locus connecting from the previous position to the current position through the passing position is drawn on the display unit. Therefore, even when the position calculated based on the information indicating the position of the predetermined point and the extreme value point deviate from each other, it is possible to draw a movement trajectory connecting from the previous position to the current position by approaching the extreme value point. .

第3の手段では、前記判定部は、前記取得部により取得された前記情報に基づいて、前記座標系において前記位置が移動する速度の少なくとも1つの成分の符号が前記描画周期内に反転する場合に、前記描画周期内に前記極値点を含むと判定する。   In the third means, the determination unit reverses the sign of at least one component of the speed at which the position moves in the coordinate system within the drawing cycle based on the information acquired by the acquisition unit. Then, it is determined that the extreme point is included in the drawing cycle.

時間に対して座標系における前記位置の少なくとも1つの成分が極値になる極値点では、座標系において前記位置が移動する速度の少なくとも1つの成分の符号が反転する。したがって、速度の少なくとも1つ成分の符号が描画周期内に反転する場合に極値点を含むと判定することで、描画周期内に極値点を含むか否かを容易に判定することができる。   At an extreme point where at least one component of the position in the coordinate system becomes extreme with respect to time, the sign of at least one component of the speed at which the position moves in the coordinate system is inverted. Therefore, it can be easily determined whether or not an extreme point is included in the drawing cycle by determining that the extreme point is included when the sign of at least one component of the velocity is inverted within the drawing cycle. .

具体的には、第4の手段のように、前記判定部は、前々回の描画周期における前記位置、前回の描画周期における前記位置、及び今回の描画周期における前記位置に基づいて、前記座標系において前記位置が移動する加速度の各成分を算出し、前記加速度の各成分が一定であるとみなして前記速度の少なくとも1つの成分の符号が次回の描画周期内に反転するか否か判定するといった構成を採用することができる。   Specifically, as in the fourth means, the determination unit uses the position in the previous drawing cycle, the position in the previous drawing cycle, and the position in the current drawing cycle in the coordinate system. A configuration in which each component of acceleration at which the position moves is calculated, and it is determined whether or not the sign of at least one component of the velocity is reversed within the next drawing cycle by regarding each component of the acceleration as being constant. Can be adopted.

また、具体的には、第5の手段のように、前記描画部は、前記判定部により前記極値点を含むと判定された場合に、前記描画周期内において前記位置が前記極値点に最も近付く制御周期における前記位置を通過位置に設定し、前記判定部は、前回の描画周期における前記位置、前記通過位置、及び今回の描画周期における前記位置に基づいて、前記座標系において前記位置が移動する加速度の各成分を算出し、前記加速度の各成分が一定であるとみなして前記速度の少なくとも1つの成分の符号が次回の描画周期内に反転するか否か判定するといった構成を採用することができる。   Specifically, as in the fifth means, when the drawing unit determines that the extremum point is included by the determination unit, the position becomes the extreme point in the drawing cycle. The position in the closest control cycle is set as a passing position, and the determination unit determines whether the position in the coordinate system is based on the position in the previous drawing cycle, the passing position, and the position in the current drawing cycle. A configuration is adopted in which each component of the moving acceleration is calculated, and it is determined whether or not the sign of at least one component of the velocity is reversed within the next drawing cycle, assuming that each component of the acceleration is constant. be able to.

第6の手段では、前記制御周期は8msであり、前記描画周期は200msである。   In the sixth means, the control cycle is 8 ms and the drawing cycle is 200 ms.

上記構成によれば、ロボットの制御周期は8msであり、移動軌跡の描画周期は200msであるため、制御周期と等しい8msの描画周期で移動軌跡を描画する構成と比較して、処理負荷を大幅に小さくすることができる。   According to the above configuration, since the robot control cycle is 8 ms and the movement trajectory drawing cycle is 200 ms, the processing load is greatly increased as compared with the configuration in which the movement trajectory is drawn at a drawing cycle of 8 ms equal to the control cycle. Can be made smaller.

ロボットシステムの斜視図Perspective view of robot system ロボット及び移動軌跡を従来技術により表示するディスプレイDisplay that displays robots and movement trajectories using conventional technology 移動軌跡描画の処理手順を示すフローチャートFlowchart showing the procedure for drawing a moving locus 直角動作における移動軌跡を示す平面図Plan view showing movement trajectory in right angle operation 鋭角動作における移動軌跡を示す平面図Plan view showing movement trajectory in acute angle operation 鈍角動作における移動軌跡を示す平面図Plan view showing movement trajectory in obtuse angle operation 各動作における移動軌跡のずれの評価結果を示す図The figure which shows the evaluation result of the shift | offset | difference of the movement locus in each operation | movement

以下、一実施形態について、図面を参照しつつ説明する。図1は、ロボットシステム10の斜視図である。ロボットシステム10は、ロボット20、コントローラ30、ティーチングペンダント40、パーソナルコンピュータ(パソコン)50等を備えている。ロボット20は、例えば部品の組立用あるいは部品の検査用など、任意の構成のロボットである。コントローラ30には、周辺機器としてティーチングペンダント40及びパソコン50等が接続されている。なお、パソコン50は、必要に応じて接続されるものであり、常時接続されている必要はない。   Hereinafter, an embodiment will be described with reference to the drawings. FIG. 1 is a perspective view of the robot system 10. The robot system 10 includes a robot 20, a controller 30, a teaching pendant 40, a personal computer (personal computer) 50, and the like. The robot 20 is a robot having an arbitrary configuration, for example, for assembling parts or for inspecting parts. A teaching pendant 40 and a personal computer 50 are connected to the controller 30 as peripheral devices. The personal computer 50 is connected as necessary, and does not need to be always connected.

ロボット20は、例えば6軸の垂直多関節型のロボットとして構成されている。ロボット20は、各軸がそれぞれアクチュエータであるサーボモータ等からの駆動力で駆動されるアーム21を有している。アーム21は、先端にエンドエフェクタ22を有している。例えばロボット20で部品の運搬や組立等を行う場合、エンドエフェクタ22としてこれらの部品を保持するためのハンドが用いられる。また、例えばロボット20で部品の検査などを行う場合、エンドエフェクタ22として対象となる部品を撮影するカメラなどが用いられる。   The robot 20 is configured as a 6-axis vertical articulated robot, for example. The robot 20 has an arm 21 in which each axis is driven by a driving force from a servo motor or the like that is an actuator. The arm 21 has an end effector 22 at the tip. For example, when parts are transported or assembled by the robot 20, a hand for holding these parts is used as the end effector 22. For example, when a part 20 is inspected by the robot 20, a camera that captures a target part is used as the end effector 22.

このように、エンドエフェクタ22は、ロボット20を適用する工程に応じて任意に選択することができる。サーボモータからアーム21のエンドエフェクタ22までの間には、図示しない減速機構やリンクなどの駆動力伝達機構が設けられている。これにより、アーム21の先端に設けられているエンドエフェクタ22は、サーボモータからの駆動力によって駆動される。ロボット20とコントローラ30との間は、接続ケーブル25によって接続されている。これにより、ロボット20の各軸を駆動するサーボモータ、および作業を実施するエンドエフェクタ22は、コントローラ30によって制御される。エンドエフェクタ22の基準点が、ロボット20の所定点に相当する。   Thus, the end effector 22 can be arbitrarily selected according to the process of applying the robot 20. Between the servo motor and the end effector 22 of the arm 21, a driving force transmission mechanism such as a speed reduction mechanism and a link (not shown) is provided. Thereby, the end effector 22 provided at the tip of the arm 21 is driven by the driving force from the servo motor. The robot 20 and the controller 30 are connected by a connection cable 25. Thus, the servo motor that drives each axis of the robot 20 and the end effector 22 that performs the work are controlled by the controller 30. The reference point of the end effector 22 corresponds to a predetermined point of the robot 20.

ティーチングペンダント40(タッチパネル式入力装置)は、例えば使用者が携帯あるいは手に所持して操作可能な程度の大きさで、例えば薄型の直方体状に形成されている。ティーチングペンダント40は、表面部の中央部に例えば液晶ディスプレイからなる表示部41を有している。表示部41には、各種の画面が表示される。表示部41は、タッチパネルで構成されている。またティーチングペンダント40には、表示部41の周囲に各種のキースイッチ42が設けられており、使用者は、キースイッチ42やタッチパネルによって種々の入力操作を行う。   The teaching pendant 40 (touch panel type input device) is formed in, for example, a thin rectangular parallelepiped shape, for example, so that the user can carry it or carry it in his hand. The teaching pendant 40 has a display unit 41 made of, for example, a liquid crystal display at the center of the surface portion. Various screens are displayed on the display unit 41. The display unit 41 is configured with a touch panel. The teaching pendant 40 is provided with various key switches 42 around the display unit 41, and the user performs various input operations using the key switches 42 and the touch panel.

ティーチングペンダント40は、ケーブル35を経由してコントローラ30に接続され、通信インターフェイスを経由してコントローラ30との間で高速のデータ転送を実行する。キースイッチ42等やタッチ操作により入力された操作信号等の情報は、ティーチングペンダント40からコントローラ30へ送信される。また、コントローラ30は、ティーチングペンダント40へ制御信号や表示用の信号などと共に駆動用の電力を供給する。   The teaching pendant 40 is connected to the controller 30 via the cable 35 and executes high-speed data transfer with the controller 30 via the communication interface. Information such as operation signals input by the key switch 42 and the touch operation is transmitted from the teaching pendant 40 to the controller 30. Further, the controller 30 supplies driving power to the teaching pendant 40 together with a control signal and a display signal.

使用者は、上記のティーチングペンダント40を用いてロボット20の運転や設定などの各種の機能を実行可能である。例えばキースイッチ42等を操作することで、予め記憶されている制御プログラムを呼び出して、ロボット20の起動や各種のパラメータの設定等を実行できる。また、ロボット20をマニュアル操作で動作させて各種の教示作業も実行可能である。表示部41には、例えばメニュー画面、設定入力画面、状況表示画面など必要に応じて所望の画面が表示される。   The user can execute various functions such as operation and setting of the robot 20 using the teaching pendant 40 described above. For example, by operating the key switch 42 or the like, it is possible to call a control program stored in advance to start the robot 20 or set various parameters. Various teaching operations can also be executed by operating the robot 20 by manual operation. A desired screen such as a menu screen, a setting input screen, a status display screen, or the like is displayed on the display unit 41 as necessary.

パソコン50(描画装置に相当)は例えば汎用のノートパソコンなどである。使用者は、プログラミングソフトを実行させることで、アプリケーションに応じてロボット20の動作手順などを記述したプログラムを作成できる。このパソコン50は、ケーブル45を経由してコントローラ30に接続され、通信インターフェイスを経由してコントローラ30との間で高速のデータ転送を実行する。作成されたプログラムは、パソコン50からコントローラ30へ転送される。本実施形態では、パソコン50は、このプログラムに基づいたロボット20の移動軌跡を、ディスプレイ51(表示部に相当)に描画する。   The personal computer 50 (corresponding to a drawing device) is, for example, a general-purpose notebook personal computer. The user can create a program describing the operation procedure of the robot 20 according to the application by executing the programming software. The personal computer 50 is connected to the controller 30 via the cable 45 and executes high-speed data transfer with the controller 30 via the communication interface. The created program is transferred from the personal computer 50 to the controller 30. In the present embodiment, the personal computer 50 draws the movement locus of the robot 20 based on this program on the display 51 (corresponding to a display unit).

コントローラ30(制御部に相当)は、図示しない記憶装置を備えており、パソコン50から転送されるプログラムを複数記憶することが可能となっている。コントローラ30は、この記憶装置に記憶されたプログラムを実行してロボット20の動作を自動制御する実動作制御機能を有している。また、コントローラ30は、上記プログラムを実行する際のロボット20の制御状態を表す制御ログを作成する。そして、パソコン50がロボット20の移動軌跡を描画する際に、コントローラ30からパソコン50に対し、この制御ログが送信される。制御ログは、ロボット20の各軸の角度データ等を含んでいる。   The controller 30 (corresponding to a control unit) includes a storage device (not shown) and can store a plurality of programs transferred from the personal computer 50. The controller 30 has an actual operation control function for automatically controlling the operation of the robot 20 by executing a program stored in the storage device. Further, the controller 30 creates a control log indicating the control state of the robot 20 when executing the program. When the personal computer 50 draws the movement locus of the robot 20, this control log is transmitted from the controller 30 to the personal computer 50. The control log includes angle data and the like of each axis of the robot 20.

使用者は、上記のティーチングペンダント40を用いて、例えばキースイッチ42等を操作することで、コントローラ30に予め記憶されたプログラムの中から1つのプログラムを選択し、そのプログラムに基づいた自動制御を開始させたり、そのプログラムに基づいた動作を画面表示させたりすることができる。この場合、ティーチングペンダント40からコントローラ30に対し、所定のプログラムを選択するための選択指令、実動作制御の実行を指令する実動作開始指令等が送信される。   The user selects one program from the programs stored in advance in the controller 30 by operating the key switch 42, for example, using the teaching pendant 40, and performs automatic control based on the program. It is possible to start or display an operation based on the program on the screen. In this case, the teaching pendant 40 transmits a selection command for selecting a predetermined program, an actual operation start command for instructing execution of actual operation control, and the like to the controller 30.

図2は、ロボット20及び移動軌跡Aを従来技術により表示するディスプレイ51である。ロボット20をコントローラ30が制御する制御周期は8msである。これに対して、従来技術では、ロボット20のエンドエフェクタ22の基準点の移動軌跡を、パソコン50がディスプレイ51に描画する描画周期は20msである。基準点の移動軌跡Aを正確に描画するためには、描画周期をできるだけ短くする、例えば制御周期8msと等しい描画周期8msにすることが望ましい。しかしながら、パソコン50が移動軌跡Aを描画する処理負荷の問題から、ロボット20の制御周期8msよりも長い描画周期20msで移動軌跡Aを描画している。   FIG. 2 shows a display 51 that displays the robot 20 and the movement trajectory A according to the prior art. The control cycle in which the controller 30 controls the robot 20 is 8 ms. On the other hand, in the prior art, the drawing cycle in which the personal computer 50 draws the movement locus of the reference point of the end effector 22 of the robot 20 on the display 51 is 20 ms. In order to accurately draw the movement locus A of the reference point, it is desirable to make the drawing cycle as short as possible, for example, to make the drawing cycle equal to 8 ms. However, due to the problem of the processing load for the personal computer 50 to draw the movement locus A, the movement locus A is drawn at a drawing cycle 20 ms longer than the control cycle 8 ms of the robot 20.

ここで、破線で示すように、基準点の実際の移動軌跡が、時間に対して基準点の位置の少なくとも1つの成分(座標)が極値になる点である極値点P2を含む場合がある。同図では、xyzの直交座標系を基準として、時間の経過に伴って極値点P2において位置のx成分(x座標)が極大値になっている。そして、極値点P2直前の描画周期における基準点の位置が点P1であり、極値点P2直後の描画周期における基準点の位置が点P3である場合、ロボット20の移動軌跡Aとして点P1と点P2とを結ぶ直線が描画される。このため、破線で示す実際の移動軌跡と、実線で示す描画された移動軌跡Aとのずれが大きくなることを本願発明者は見出した。すなわち、極値点では、座標系の少なくとも1つの成分に関して、基準点が移動する方向が反転するため、移動軌跡の変化が大きくなる。同図では、極値点P2では、xyz座標系のx成分に関して、基準点が移動する方向が反転している。   Here, as shown by a broken line, the actual movement trajectory of the reference point may include an extreme point P2, which is a point at which at least one component (coordinate) of the position of the reference point becomes an extreme value with respect to time. is there. In the figure, the x component (x coordinate) of the position at the extreme value point P2 becomes a local maximum value with the passage of time with reference to the orthogonal coordinate system of xyz. When the position of the reference point in the drawing cycle immediately before the extreme value point P2 is the point P1, and the position of the reference point in the drawing cycle immediately after the extreme value point P2 is the point P3, the point P1 is the movement locus A of the robot 20. And a straight line connecting point P2 is drawn. For this reason, this inventor discovered that the shift | offset | difference of the actual movement locus | trajectory shown with a broken line and the drawn movement locus | trajectory A shown with a continuous line becomes large. That is, at the extreme value point, the direction of movement of the reference point is reversed with respect to at least one component of the coordinate system, so that the change of the movement locus becomes large. In the figure, at the extreme point P2, the direction in which the reference point moves is reversed with respect to the x component of the xyz coordinate system.

そこで、本実施形態では、描画周期内に極値点を含むか否かを判定し、極値点を含むと判定された場合に、前回の描画周期における基準点の位置から極値点に寄って今回の描画周期における基準点の位置へ結ぶ移動軌跡をディスプレイ51に描画する。同図では、点P1から点P3までの移動軌跡を描画する描画周期内に、極値点P2を含むと判定された場合に、点P1から極値点P2に寄って点P3へ結ぶ移動軌跡を描画する。   Therefore, in the present embodiment, it is determined whether or not an extreme point is included in the drawing cycle. When it is determined that the extreme point is included, the extreme point is shifted from the position of the reference point in the previous drawing cycle. Thus, the movement locus connected to the position of the reference point in the current drawing cycle is drawn on the display 51. In this figure, when it is determined that the extremum point P2 is included in the drawing cycle for drawing the movement trajectory from the point P1 to the point P3, the movement trajectory connecting the point P1 to the point P3 from the point P1. Draw.

また、ロボット20の基準点の位置が極値点P2となるタイミングと、制御周期における位置取得タイミングとがずれることがある。この場合、基準点の位置を表す情報に基づいて算出される位置と極値点P2とがずれることとなる。そこで、描画周期内に極値点P2を含むと判定した場合に、描画周期内において基準点の位置が極値点P2に最も近付く制御周期における基準点の位置を通過位置に設定する。そして、前回位置から通過位置を通過して今回位置へ結ぶ移動軌跡をディスプレイ51に描画する。   In addition, the timing at which the position of the reference point of the robot 20 becomes the extreme point P2 may deviate from the position acquisition timing in the control cycle. In this case, the position calculated based on the information indicating the position of the reference point and the extreme value point P2 are shifted. Therefore, when it is determined that the extreme point P2 is included in the drawing cycle, the position of the reference point in the control cycle in which the position of the reference point is closest to the extreme point P2 in the drawing cycle is set as the passing position. Then, a movement trajectory passing through the passing position from the previous position and connecting to the current position is drawn on the display 51.

図3は、移動軌跡描画の処理手順を示すフローチャートである。この一連の処理は、パソコン50によって描画周期20msで繰り返し実行される。   FIG. 3 is a flowchart showing a processing procedure for drawing a movement trajectory. This series of processing is repeatedly executed by the personal computer 50 at a drawing cycle of 20 ms.

まず、描画周期内の各制御周期での制御ログを、コントローラ30から取得する(S11)。具体的には、コントローラ30との通信により、ロボット20の各軸の角度データを受信する。   First, a control log in each control cycle within the drawing cycle is acquired from the controller 30 (S11). Specifically, the angle data of each axis of the robot 20 is received by communication with the controller 30.

続いて、極値点フラグがT(True)であるか否か判定する(S12)。後述するように、極値点フラグは、前回の描画から今回の描画までの描画周期内に、極値点を含む場合にT(True)とされ、極値点を含まない場合にF(False)とされる。   Subsequently, it is determined whether or not the extreme point flag is T (True) (S12). As will be described later, the extreme point flag is set to T (True) when the extreme point is included in the drawing cycle from the previous drawing to the current drawing, and F (False) when the extreme point is not included. ).

上記判定において、極値点フラグがTであると判定した場合(S12:YES)、極値点時期に基づいて通過位置を設定する(S13)。後述するように、描画周期内に極値点を含むと判定された場合は、エンドエフェクタ22の基準点の移動軌跡が極値点となる時期である極値点時期が算出されている。このため、描画周期内の各制御周期における制御ログのうち、極値点時期に最も近い時期の制御ログを用いて、エンドエフェクタ22の基準点の位置を算出する。具体的には、ロボット20の各軸の角度から、基準点の位置を算出し、算出した基準点の位置を通過位置に設定する。   In the above determination, when it is determined that the extreme point flag is T (S12: YES), the passing position is set based on the extreme point time (S13). As will be described later, when it is determined that the extreme point is included in the drawing cycle, the extreme point time, which is the time when the movement locus of the reference point of the end effector 22 becomes the extreme point, is calculated. For this reason, the position of the reference point of the end effector 22 is calculated using the control log at the time closest to the extreme point time among the control logs in each control cycle within the drawing cycle. Specifically, the position of the reference point is calculated from the angle of each axis of the robot 20, and the calculated position of the reference point is set as the passing position.

続いて、前回の描画周期における基準点の位置(以下「前回位置」という)と、上記通過位置とを結ぶ直線を移動軌跡として描画する(S14)。   Subsequently, a straight line connecting the position of the reference point (hereinafter referred to as “previous position”) in the previous drawing cycle and the passing position is drawn as a movement locus (S14).

一方、S12の判定において、極値点フラグがFであると判定した場合(S12:NO)、通過位置の設定(S15)、及び前回位置と通過位置とを結ぶ直線の描画(S14)は行わない。   On the other hand, if it is determined in S12 that the extreme point flag is F (S12: NO), the passing position is set (S15) and the straight line connecting the previous position and the passing position is drawn (S14). Absent.

続いて、今回の描画周期における基準点の位置(以下「今回位置」という)を算出する(S15)。具体的には、描画周期内の各制御周期における制御ログのうち、最後の制御周期の制御ログを用いて、エンドエフェクタ22の基準点の位置を算出する。   Subsequently, the position of the reference point (hereinafter referred to as “current position”) in the current drawing cycle is calculated (S15). Specifically, the position of the reference point of the end effector 22 is calculated using the control log of the last control cycle among the control logs in each control cycle within the drawing cycle.

続いて、最後の2つの基準点の位置を結ぶ直線を、移動軌跡として描画する(S16)。具体的には、通過位置が設定されていれば、通過位置と今回位置とを結ぶ直線を描画する。一方、通過位置が設定されていなければ、前回位置と今回位置とを結ぶ直線を描画する。なお、初回の描画周期における処理では、通過位置及び前回位置が存在しないため、この処理を行わない。   Subsequently, a straight line connecting the positions of the last two reference points is drawn as a movement locus (S16). Specifically, if the passing position is set, a straight line connecting the passing position and the current position is drawn. On the other hand, if the passing position is not set, a straight line connecting the previous position and the current position is drawn. In the process in the first drawing cycle, since there is no passing position and no previous position, this process is not performed.

続いて、最後の3つの基準点の位置から、基準点が移動する加速度の各成分を算出する(S17)。具体的には、通過位置が設定されていれば、前回位置、通過位置、及び今回位置から、基準点が移動する加速度の各成分を算出する。例えば、前回位置、通過位置、及びその間の時間から第1速度を算出し、通過位置、今回位置、及びその間の時間から第2速度を算出する。そして、第1速度及び第2速度から加速度を算出する。これを、x成分、y成分、及びz成分についてそれぞれ行って、加速度のx成分ax、y成分ay、及びz成分azを損出する。一方、通過位置が設定されていなければ、前々回位置、前回位置、及び今回位置から、同様にして基準点が移動する加速度の各成分ax,ay,azを算出する。なお、最後の3つの基準点の位置が存在しない場合、例えば初回の描画周期における処理では、この処理を行わない。   Subsequently, each component of acceleration at which the reference point moves is calculated from the positions of the last three reference points (S17). Specifically, if a passing position is set, each component of acceleration at which the reference point moves is calculated from the previous position, the passing position, and the current position. For example, the first speed is calculated from the previous position, the passing position, and the time between them, and the second speed is calculated from the passing position, the current position, and the time between them. Then, acceleration is calculated from the first speed and the second speed. This is performed for each of the x component, the y component, and the z component, and the x component ax, the y component ay, and the z component az of the acceleration are lost. On the other hand, if the passing position is not set, the components ax, ay, and az of the acceleration in which the reference point moves are calculated in the same manner from the previous position, the previous position, and the current position. Note that when the positions of the last three reference points do not exist, this process is not performed, for example, in the process in the first drawing cycle.

続いて、基準点の速度の少なくとも1つの成分の符号が、次回の制御周期内に反転するか否か判定する(S18)。具体的には、基準位置の加速度が上記算出した加速度で一定であるとみなして、今回の制御周期での基準点の速度の符号と、次回の制御周期での基準点の速度の符号とが異なるか否か判定する。この判定を、x成分、y成分、及びz成分についてそれぞれ行う。   Subsequently, it is determined whether or not the sign of at least one component of the reference point speed is reversed within the next control cycle (S18). Specifically, assuming that the acceleration at the reference position is constant at the calculated acceleration, the sign of the reference point speed in the current control cycle and the sign of the reference point speed in the next control cycle are Determine if they are different. This determination is performed for each of the x component, the y component, and the z component.

上記判定において、速度vのx成分vx、y成分vy、及びz成分vzの少なくとも1つの符号が反転すると判定した場合(S18:YES)、上記極値点フラグ=Tとする(S19)。そして、基準点の移動軌跡が極値点となる時期である極値点時期を算出する(S20)。具体的には、速度vのx成分vx、y成分vy、及びz成分vzのいずれかが0になる時期を、極値点時期として算出する。   In the above determination, when it is determined that at least one sign of the x component vx, the y component vy, and the z component vz of the velocity v is reversed (S18: YES), the extreme point flag is set to T (S19). Then, an extreme point time, which is a time when the movement locus of the reference point becomes an extreme point, is calculated (S20). Specifically, the time when any of the x component vx, the y component vy, and the z component vz of the velocity v becomes 0 is calculated as the extreme point time.

一方、S18の判定において、速度vのx成分vx、y成分vy、及びz成分vzのいずれの符号も反転しないと判定した場合(S18:NO)、極値点フラグ=Fとする(S21)。   On the other hand, if it is determined in S18 that none of the signs of the x component vx, y component vy, and z component vz of the speed v is reversed (S18: NO), the extreme point flag is set to F (S21). .

その後、この一連の処理を一旦終了する(END)。なお、S11の処理が取得部としての処理に相当し、S12〜S16の処理が描画部としての処理に相当し、S17〜S19及びS21の処理が判定部としての処理に相当する。   Thereafter, this series of processing is temporarily terminated (END). In addition, the process of S11 corresponds to the process as an acquisition part, the process of S12-S16 corresponds to the process as a drawing part, and the process of S17-S19 and S21 corresponds to the process as a determination part.

図4は、ロボット20のエンドエフェクタ22の基準点を、直角動作させる移動軌跡を示す平面図である。同様に、図5は鋭角動作における移動軌跡を示す平面図であり、図6は鈍角動作における移動軌跡を示す平面図である。なお、図4〜6において、基準点のz座標(z成分)は所定値で固定している。   FIG. 4 is a plan view showing a movement locus in which the reference point of the end effector 22 of the robot 20 is moved at a right angle. Similarly, FIG. 5 is a plan view showing a movement locus in an acute angle operation, and FIG. 6 is a plan view showing a movement locus in an obtuse angle operation. 4 to 6, the z coordinate (z component) of the reference point is fixed at a predetermined value.

図7は、図4〜6の各動作における移動軌跡のずれの評価結果を、従来技術と比較して示す図である。ここでは、各制御周期における基準点の実際の位置と、描画された移動軌跡上における各制御周期に対応する基準点の位置とで、相関係数を算出した。相関係数は、基準点のx座標(x成分)及びy座標(y成分)についてそれぞれ算出した。相関係数は、1に近いほど相関が高いことを表している。@Eは、現在位置から目標位置へ移動する際に、ロボット20の各軸の角度が目標角度になってから、次の目標位置へ移動するモードである。@Pは、現在位置から目標位置へ移動する際に、ロボット20の各軸の角度が減速を開始したら、現在の目標位置への移動に併せて次の目標位置への移動を開始するモードである。   FIG. 7 is a diagram showing the evaluation result of the shift of the movement trajectory in each operation of FIGS. 4 to 6 in comparison with the prior art. Here, the correlation coefficient is calculated from the actual position of the reference point in each control cycle and the position of the reference point corresponding to each control cycle on the drawn movement trajectory. The correlation coefficient was calculated for each of the x coordinate (x component) and the y coordinate (y component) of the reference point. The correlation coefficient indicates that the closer to 1, the higher the correlation. @E is a mode for moving to the next target position after the angle of each axis of the robot 20 reaches the target angle when moving from the current position to the target position. @P is a mode in which, when moving from the current position to the target position, if the angle of each axis of the robot 20 starts decelerating, the movement to the next target position is started along with the movement to the current target position. is there.

これらの評価結果から明らかなように、本実施形態は、いずれの動作及びモードにおいても、従来技術と比較して相関係数が1に近くなっている。特に、鋭角動作のモード@Eのy座標において、ずれの縮小が顕著となっている。この場合、図5に示すように、y座標に関して、各目標位置が極値点となっているため、前回位置から極値点に寄って今回位置へ結ぶ本実施形態の効果が高くなったと考えられる。   As is clear from these evaluation results, in this embodiment, the correlation coefficient is close to 1 in any operation and mode as compared with the prior art. In particular, in the y-coordinate of the acute angle operation mode @E, the reduction of the deviation is remarkable. In this case, as shown in FIG. 5, since each target position is an extreme point with respect to the y coordinate, it is considered that the effect of the present embodiment in which the previous position is approached to the extreme point to connect to the current position is enhanced. It is done.

以上詳述した本実施形態は、以下の利点を有する。   The embodiment described in detail above has the following advantages.

・描画周期内に極値点を含まないと判定された場合に、前回位置と今回位置とを結ぶ移動軌跡がディスプレイ51に描画される。このため、基準点が移動する方向が反転せず、実際の移動軌跡と描画される移動軌跡とがずれにくい場合は、パソコン50が移動軌跡を描画する処理負荷を小さくすることができる。   When it is determined that the extreme point is not included in the drawing cycle, the movement locus connecting the previous position and the current position is drawn on the display 51. For this reason, when the direction in which the reference point moves is not reversed and the actual movement locus and the drawn movement locus are difficult to shift, the processing load for the personal computer 50 to draw the movement locus can be reduced.

・描画周期内に極値点を含むと判定された場合に、前回位置から極値点に寄って今回位置へ結ぶ移動軌跡がディスプレイ51に描画される。このため、基準点が移動する方向が反転し、実際の移動軌跡と描画される移動軌跡とがずれ易い場合は、前回位置と今回位置との間で極値点に寄るように移動軌跡が描画される。したがって、ロボット20の実際の移動軌跡と描画される移動軌跡とのずれを抑制することができる。さらに、前回位置と今回位置との間で極値点に寄るだけであるため、パソコン50が移動軌跡を描画する処理負荷の増大を抑制することができる。   When it is determined that the extremum point is included in the drawing cycle, a movement trajectory connecting from the previous position to the current position from the previous position is drawn on the display 51. For this reason, if the direction in which the reference point moves is reversed and the actual movement locus and the drawn movement locus are likely to deviate, the movement locus is drawn so as to approach the extreme point between the previous position and the current position. Is done. Accordingly, it is possible to suppress a deviation between the actual movement locus of the robot 20 and the drawn movement locus. Furthermore, since only the extreme point is between the previous position and the current position, an increase in processing load for the personal computer 50 to draw the movement trajectory can be suppressed.

・描画周期内に極値点を含むと判定された場合に、描画周期内において基準点の位置が極値点に最も近付く制御周期における基準点の位置が通過位置に設定される。そして、前回位置から通過位置を通過して今回位置へ結ぶ移動軌跡がディスプレイ51に描画される。したがって、基準点の位置を表す情報に基づいて算出される位置と極値点とがずれる場合であっても、前回位置から極値点に寄って今回位置へ結ぶ移動軌跡を描画することができる。   When it is determined that the extreme point is included in the drawing cycle, the position of the reference point in the control cycle in which the position of the reference point is closest to the extreme point in the drawing cycle is set as the passing position. Then, a movement trajectory connecting from the previous position to the current position through the passing position is drawn on the display 51. Therefore, even when the position calculated based on the information indicating the position of the reference point and the extreme value point deviate from each other, it is possible to draw a movement trajectory connecting the extreme value point from the previous position to the current position. .

・時間に対してxyz座標系における基準点の位置の少なくとも1つの成分が極値になる極値点では、xyz座標系において基準点の位置が移動する速度vの少なくとも1つの成分の符号が反転する。したがって、速度vの少なくとも1つ成分の符号が描画周期内に反転する場合に極値点を含むと判定することで、描画周期内に極値点を含むか否かを容易に判定することができる。   At the extreme point where at least one component of the reference point position in the xyz coordinate system becomes an extreme value with respect to time, the sign of at least one component of the velocity v at which the reference point position moves in the xyz coordinate system is inverted. To do. Therefore, it is possible to easily determine whether or not an extreme point is included in the drawing cycle by determining that the extreme point is included when the sign of at least one component of the velocity v is reversed within the drawing cycle. it can.

・ロボット20の制御周期は8msであり、移動軌跡の描画周期は200msであるため、制御周期と等しい8msの描画周期で移動軌跡を描画する構成と比較して、パソコン50の処理負荷を大幅に小さくすることができる。   -Since the control cycle of the robot 20 is 8 ms and the drawing cycle of the moving track is 200 ms, the processing load of the personal computer 50 is greatly increased compared to the configuration in which the moving track is drawn with a drawing cycle of 8 ms equal to the control cycle. Can be small.

なお、上記実施形態を、以下のように変更して実施することもできる。上記実施形態と同一の部材については、同一の符号を付すことにより説明を省略する。   In addition, the said embodiment can also be changed and implemented as follows. About the same member as the said embodiment, description is abbreviate | omitted by attaching | subjecting the same code | symbol.

・ロボット20の制御周期は8msに限らず、移動軌跡の描画周期は200msに限らない。例えば、ロボット20の制御周期が16msであり、移動軌跡の描画周期が400msであってもよい。要するに、ロボット20の制御周期よりも長い描画周期で、ロボット20の移動軌跡をディスプレイ51に描画するものであればよい。   The control cycle of the robot 20 is not limited to 8 ms, and the drawing cycle of the movement locus is not limited to 200 ms. For example, the control cycle of the robot 20 may be 16 ms, and the drawing cycle of the movement locus may be 400 ms. In short, what is necessary is just to draw the movement locus of the robot 20 on the display 51 with a drawing cycle longer than the control cycle of the robot 20.

・前回位置と今回位置との間の極値点の位置を、極値点の前後に対応する制御ログから補間して算出してもよい。そして、算出した極値点の位置を、前回位置と今回位置との間の通過位置に設定してもよい。こうした構成によれば、実際の移動軌跡と描画される移動軌跡とのずれを更に抑制することができる。   The position of the extreme point between the previous position and the current position may be calculated by interpolating from control logs corresponding to before and after the extreme point. Then, the calculated position of the extreme value point may be set to a passing position between the previous position and the current position. According to such a configuration, it is possible to further suppress the deviation between the actual movement locus and the drawn movement locus.

・前回位置、通過位置、及び今回位置を結ぶ線は、直線に限らず、前回位置までの移動軌跡の形状を近似した近似曲線に基づく曲線等であってもよい。   The line connecting the previous position, the passing position, and the current position is not limited to a straight line, and may be a curve based on an approximate curve that approximates the shape of the movement locus up to the previous position.

・ロボット20の基準となる座標系は、xyzの直交座標系に限らず、円筒座標系等であってもよい。   The coordinate system serving as a reference for the robot 20 is not limited to the xyz orthogonal coordinate system, and may be a cylindrical coordinate system or the like.

・描画装置は、パソコン50に限らず、コントローラ30や、ティーチングペンダント40により構成されていてもよい。また、表示部は、パソコン50のディスプレイ51に限らず、ティーチングペンダント40の表示部41により構成されていてもよい。   The drawing apparatus is not limited to the personal computer 50, and may be configured by the controller 30 or the teaching pendant 40. Further, the display unit is not limited to the display 51 of the personal computer 50 and may be configured by the display unit 41 of the teaching pendant 40.

・ロボットとして、垂直多関節ロボットに限らず、水平多関節ロボット等を採用することもできる。   -As a robot, not only a vertical articulated robot but a horizontal articulated robot can also be adopted.

20…ロボット、22…エンドエフェクタ、30…コントローラ(制御部)、41…表示部、50パーソナルコンピュータ(描画装置)、51…ディスプレイ(表示部)。   DESCRIPTION OF SYMBOLS 20 ... Robot, 22 ... End effector, 30 ... Controller (control part), 41 ... Display part, 50 personal computer (drawing apparatus), 51 ... Display (display part).

Claims (6)

ロボットを所定の制御周期で制御する制御部からの信号に基づいて、前記制御周期よりも長い描画周期で前記ロボットの移動軌跡を表示部に描画する描画装置であって、
前記制御部から各制御周期における前記ロボットの所定点の位置を表す情報を取得する取得部と、
前記取得部により取得された前記情報に基づいて、時間に対して座標系における前記位置の少なくとも1つの成分が極値になる極値点を、前記描画周期内に含むか否かを判定する判定部と、
前記判定部により前記極値点を含まないと判定された場合に、前回の描画周期における前記位置と今回の描画周期における前記位置とを結ぶ前記移動軌跡を前記表示部に描画し、前記判定部により前記極値点を含むと判定された場合に、前回の描画周期における前記位置から前記極値点に寄って今回の描画周期における前記位置へ結ぶ前記移動軌跡を前記表示部に描画する描画部と、
を備えることを特徴とするロボットの移動軌跡描画装置。
A drawing apparatus that draws a movement locus of the robot on a display unit at a drawing cycle longer than the control cycle based on a signal from a control unit that controls the robot at a predetermined control cycle,
An acquisition unit that acquires information representing the position of the predetermined point of the robot in each control cycle from the control unit;
Determination to determine whether or not the drawing cycle includes an extreme point where at least one component of the position in the coordinate system with respect to time is an extreme value based on the information acquired by the acquisition unit And
When the determination unit determines that the extreme point is not included, the movement locus connecting the position in the previous drawing cycle and the position in the current drawing cycle is drawn on the display unit, and the determination unit A drawing unit that draws on the display unit the movement trajectory connecting from the position in the previous drawing cycle to the position in the current drawing cycle from the position in the previous drawing cycle When,
A robot movement trajectory drawing apparatus comprising:
前記描画部は、前記判定部により前記極値点を含むと判定された場合に、前記描画周期内において前記位置が前記極値点に最も近付く制御周期における前記位置を通過位置に設定し、前回の描画周期における前記位置から前記通過位置を通過して今回の描画周期における前記位置へ結ぶ前記移動軌跡を前記表示部に描画する請求項1に記載のロボットの移動軌跡描画装置。   When the determination unit determines that the extreme point is included by the determination unit, the drawing unit sets the position in the control cycle in which the position is closest to the extreme point in the drawing cycle as a passing position, The robot movement locus drawing apparatus according to claim 1, wherein the movement locus is drawn on the display unit from the position in the drawing cycle to the position in the current drawing cycle through the passing position. 前記判定部は、前記取得部により取得された前記情報に基づいて、前記座標系において前記位置が移動する速度の少なくとも1つの成分の符号が前記描画周期内に反転する場合に、前記描画周期内に前記極値点を含むと判定する請求項1又は2に記載のロボットの移動軌跡描画装置。   Based on the information acquired by the acquisition unit, the determination unit includes the at least one component of the velocity at which the position moves in the coordinate system within the drawing cycle. The robot movement trajectory drawing apparatus according to claim 1, wherein the robot trajectory is determined to include the extreme point. 前記判定部は、前々回の描画周期における前記位置、前回の描画周期における前記位置、及び今回の描画周期における前記位置に基づいて、前記座標系において前記位置が移動する加速度の各成分を算出し、前記加速度の各成分が一定であるとみなして前記速度の少なくとも1つの成分の符号が次回の描画周期内に反転するか否か判定する請求項3に記載のロボットの移動軌跡描画装置。   The determination unit calculates each component of acceleration at which the position moves in the coordinate system based on the position in the previous drawing cycle, the position in the previous drawing cycle, and the position in the current drawing cycle, The robot movement trajectory drawing apparatus according to claim 3, wherein each component of the acceleration is considered to be constant and it is determined whether or not the sign of at least one component of the velocity is reversed within a next drawing cycle. 前記描画部は、前記判定部により前記極値点を含むと判定された場合に、前記描画周期内において前記位置が前記極値点に最も近付く制御周期における前記位置を通過位置に設定し、
前記判定部は、前回の描画周期における前記位置、前記通過位置、及び今回の描画周期における前記位置に基づいて、前記座標系において前記位置が移動する加速度の各成分を算出し、前記加速度の各成分が一定であるとみなして前記速度の少なくとも1つの成分の符号が次回の描画周期内に反転するか否か判定する請求項3に記載のロボットの移動軌跡描画装置。
When the drawing unit determines that the extreme point is included by the determination unit, the drawing unit sets the position in the control cycle where the position is closest to the extreme point within the drawing cycle as a passing position;
The determination unit calculates each component of acceleration at which the position moves in the coordinate system based on the position in the previous drawing cycle, the passing position, and the position in the current drawing cycle, The robot movement trajectory drawing apparatus according to claim 3, wherein the component is considered to be constant and it is determined whether or not the sign of at least one component of the velocity is reversed within a next drawing cycle.
前記制御周期は8msであり、前記描画周期は200msである請求項1〜5のいずれか1項に記載のロボットの移動軌跡描画装置。   The robot movement trajectory drawing apparatus according to claim 1, wherein the control cycle is 8 ms and the drawing cycle is 200 ms.
JP2015230058A 2015-11-25 2015-11-25 Robot moving locus drawing apparatus Pending JP2017094458A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2015230058A JP2017094458A (en) 2015-11-25 2015-11-25 Robot moving locus drawing apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2015230058A JP2017094458A (en) 2015-11-25 2015-11-25 Robot moving locus drawing apparatus

Publications (1)

Publication Number Publication Date
JP2017094458A true JP2017094458A (en) 2017-06-01

Family

ID=58804334

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2015230058A Pending JP2017094458A (en) 2015-11-25 2015-11-25 Robot moving locus drawing apparatus

Country Status (1)

Country Link
JP (1) JP2017094458A (en)

Similar Documents

Publication Publication Date Title
US10166673B2 (en) Portable apparatus for controlling robot and method thereof
JP6619395B2 (en) Robot system and robot teaching method
US7194396B2 (en) Simulation device
US11370105B2 (en) Robot system and method for operating same
US20150273689A1 (en) Robot control device, robot, robotic system, teaching method, and program
US20180029232A1 (en) Control apparatus and robot
US10603788B2 (en) Robot simulation apparatus
CN105209225B (en) The control system and control method of the action of control industrial robot and ancillary equipment
KR101876845B1 (en) Robot control apparatus
US11865697B2 (en) Robot system and method for operating same
JP2019061523A (en) Information processing unit, information processing method, and program
US10532460B2 (en) Robot teaching device that sets teaching point based on motion image of workpiece
JP2019171498A (en) Robot program execution device, robot program execution method and program
US10315305B2 (en) Robot control apparatus which displays operation program including state of additional axis
US12466067B2 (en) Multi-mode robot programming
JP2020049569A (en) Robot program creation support device
CN108687758B (en) Moving speed control device and method for robot
US20160318185A1 (en) Device for dynamic switching of robot control points
US20240066694A1 (en) Robot control system, robot control method, and robot control program
WO2020059342A1 (en) Robot simulator
JP2013226602A (en) Industrial machine system
JP2017094458A (en) Robot moving locus drawing apparatus
US20230381950A1 (en) Robot control system
WO2025102363A1 (en) Method for controlling movement of robot, electronic device, and computer readable storage medium
JP2016000439A (en) Robot device