WO2022039245A1 - ロボット制御装置 - Google Patents

ロボット制御装置 Download PDF

Info

Publication number
WO2022039245A1
WO2022039245A1 PCT/JP2021/030483 JP2021030483W WO2022039245A1 WO 2022039245 A1 WO2022039245 A1 WO 2022039245A1 JP 2021030483 W JP2021030483 W JP 2021030483W WO 2022039245 A1 WO2022039245 A1 WO 2022039245A1
Authority
WO
WIPO (PCT)
Prior art keywords
wrist
joints
point
control
control point
Prior art date
Application number
PCT/JP2021/030483
Other languages
English (en)
French (fr)
Inventor
悦来 王
康広 内藤
Original Assignee
ファナック株式会社
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 ファナック株式会社 filed Critical ファナック株式会社
Priority to CN202180050474.5A priority Critical patent/CN115943019A/zh
Priority to JP2022544008A priority patent/JP7469482B2/ja
Priority to DE112021003148.1T priority patent/DE112021003148T5/de
Priority to US18/015,268 priority patent/US20230256598A1/en
Publication of WO2022039245A1 publication Critical patent/WO2022039245A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1643—Programme controls characterised by the control loop redundant control
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1612—Programme controls characterised by the hand, wrist, grip control
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40328—If joint near singularity, restore angle to start values, adapt other joints
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40354—Singularity detection

Definitions

  • the present invention relates to a robot control device.
  • the robot control device determines that an error has occurred and takes measures such as stopping the operation of the robot. Therefore, every time an error occurs, additional work such as re-teaching another trajectory and restarting the robot is required.
  • One aspect of the present disclosure is a robot control device that controls an articulated robot, wherein the robot has a plurality of basic joints that change the position of the wrist portion and an end connected to the wrist portion or the wrist portion. It has a plurality of wrist joints that change the position and posture of the control points set on the effector, and by controlling the plurality of basic joints and the plurality of wrist joints, the control points can be moved from the first position to the second position.
  • a position information recording unit that records position information including a control unit that moves to a position, a position of the second position, and rotation angles of each of the plurality of wrist joints when the control point is located at the second position.
  • the control unit When the posture of the wrist portion when the control point is located at the second position is not a singular point, the control unit causes the plurality of basic joints and the plurality of wrist joints to cooperate with each other.
  • the control unit moves. It is a robot control device that moves the control point to the second position by operating each axis without coordinating the plurality of wrist joints with each other.
  • the robot control device 1 is connected to an articulated robot 2 provided with a wrist portion 3 and controls the robot 2.
  • the robot 2 has a plurality of basic joints J1, J2, J3 that three-dimensionally change the position of the wrist portion 3, and the positions (X, Y, Z) and postures (W, P, R) of the control points Pc. It is equipped with a plurality of wrist joints J4, J5, J6 that can be changed three-dimensionally.
  • the control point Pc is a point set at a predetermined position of the wrist portion 3 or a point set at a predetermined position of the end effector 8 connected to the wrist portion 3.
  • the control point Pc is the center point of the tip surface 3a of the wrist portion 3 or TCP (tool center point).
  • the robot 2 is a 6-axis vertical articulated robot having 6 joints J1 to J6.
  • the robot 2 has a base 4 fixed to the floor, a swivel cylinder 5 arranged on the base 4, a first arm 6 connected to the swivel cylinder 5, and a second arm 6 connected to the tip of the first arm 6. It is equipped with an arm 7.
  • the wrist portion 3 is connected to the tip of the second arm 7 and has a tip surface 3a to which an end effector 8 such as a hand or a tool can be attached.
  • Each joint J1 to J6 is provided with a servomotor that drives each joint J1 to J6 according to a control command from the robot control device 1, and an encoder that detects the rotation angle of each joint J1 to J6.
  • the basic joints are the first joint J1, the second joint J2, and the third joint J3.
  • the first joint J1 rotates the swivel body 5 around the first axis A1 in the vertical direction with respect to the base 4.
  • the second joint J2 rotates the first arm 6 around the horizontal second axis A2 with respect to the swivel cylinder 5.
  • the third joint J3 rotates the second arm 7 around the horizontal third axis A3 with respect to the first arm 6.
  • the wrist joints are the 4th joint J4, the 5th joint J5, and the 6th joint J6.
  • the fourth joint J4 rotates the second arm 7 around the fourth axis A4 with respect to the first arm 6.
  • the fifth joint J5 rotates the wrist portion 3 around the fifth axis A5 with respect to the second arm 7.
  • the sixth joint J6 rotates the tip surface 3a of the wrist portion 3 around the sixth axis A6.
  • the fourth axis A4 extends along the longitudinal axis of the second arm 7, the fifth axis A5 is orthogonal to the fourth axis A4, and the sixth axis A6 is orthogonal to the fifth axis A5.
  • the robot control device 1 includes a storage unit 11 and a control unit 12.
  • the storage unit 11 has a storage device such as a RAM (random access memory), a ROM (read-only memory), and an HDD (hard disk drive).
  • the robot control device 1 is provided with at least one processor such as a central processing unit.
  • the storage unit 11 stores a control program for causing the processor to execute the processing described later in the control unit 12. That is, the control unit 12 is realized by at least one processor.
  • the control unit 12 calculates a straight line trajectory T extending straight from the first position P1 to the second position P2 by linearly interpolating between the first position P1 and the second position P2.
  • the first position P1 and the second position P2 are arbitrary three-dimensional positions set by the operator, and are teaching points taught in teaching work such as direct teach.
  • the control unit 12 moves the control point Pc from the first position P1 to the second position P2 by controlling the joints J1 to J6.
  • the control unit 12 calculates the rotation angles of the wrist joints J4, J5, and J6 when the control point Pc is located at the second position P2 in the set posture by inverse kinematics. ..
  • the posture of the control point Pc (posture of the tip surface 3a) is set by the operator in the same manner as in the first position P1 and the second position P2.
  • the calculated position information including each rotation angle of the wrist joints J4, J5, J6 and the three-dimensional position (X2, Y2, Z2) of the second position P2 is stored in the storage unit (position information recording unit) 11. It is memorized (recorded).
  • the control unit 12 determines whether or not the posture of the wrist portion 3 when the control point Pc is located at the second position P2 is a singular point or a vicinity of the singular point. Next, the control unit 12 moves the control point Pc from the first position P1 to the second position by linearly or each axis-moving the joints J1 to J6 according to the determination result. The method of controlling the joints J1 to J6 by the control unit 12 will be described in detail later.
  • the region S indicates a singular point region in which the posture of the wrist portion 3 is arranged at the singular point or in the vicinity of the singular point.
  • the singular point is a posture in which the fourth axis A4 and the sixth axis A6 are arranged in a straight line.
  • the control unit 12 has a rotation angle ⁇ between the fourth axis line A4 and the sixth axis line A6 when the control point Pc is located at the second position P2 based on the position information stored in the storage unit 11. Is calculated.
  • the control unit 12 has a singular point or a singularity in the posture of the wrist portion 3 when the control point Pc is located at the second position P2. It is determined that the area is near the point.
  • a predetermined threshold value for example, 5 ° or less
  • the operation of the robot control device 1 will be described.
  • the operator sets the first position P1 (X1, Y1, Z1) and the second position P2 (X2, Y2, Z2) as teaching positions.
  • the posture (W1, P1, R1) of the control point Pc is set as the teaching posture.
  • the first position P1 (X1, Y1, Z1), the second position P2 (X2, Y2, Z2) and the posture (W1, P1, R1) are stored in the storage unit 11.
  • control unit 12 determines whether or not the posture of the wrist portion 3 when the control point Pc is located at the second position P2 in the set posture (W1, P1, R1) is a singular point. ..
  • the joints J1 to J6 are controlled by the control unit 12, and the control point Pc moves from the first position P1 to the second position P2 by the linear motion of the joints J1 to J6 or the motion of each axis.
  • the control unit 12 sets the control point Pc by linearly operating the joints J1 to J6 in coordination with each other. While maintaining the posture (W1, P1, R1), it is linearly moved along the linear trajectory T from the first position P1 (X1, Y1, Z1) to the second position P2 (X2, Y2, Z2). Specifically, the control unit 12 reverse kinematics the rotation angle of each joint J1 to J6 when the control point Pc is located at each position on the straight line trajectory T in the set posture (W1, P1, R1).
  • the time-series data of the rotation angle for linearly moving the control point Pc from the first position P1 to the second position P2 while maintaining the postures (W1, P1, R1) is obtained.
  • the control unit 12 controls the joints J1 to J6 according to the calculated time-series data of the angles.
  • the control unit 12 operates the basic joints J1, J2, J3 in a straight line while performing the wrist joints J4, J5, 5.
  • the control point Pc is moved from the first position P1 to the second position P2.
  • the linear motion of the basic joints J1, J2 and J3 is performed by controlling the joints J1, J2 and J3 according to the time-series data of the rotation angles of the respective joints J1, J2 and J3 obtained by the above method.
  • the control unit 12 determines the rotation angle of each wrist joint J4, J5, J6 when the control point Pc is located at the first position P1 in the set posture (W1, P1, R1), and the control point. The difference from the rotation angle of each wrist joint J4, J5, J6 when the Pc is located at the second position P2 in the set posture (W1, P1, R1) is calculated. Next, the control unit 12 operates each wrist joint J4, J5, J6 individually by the calculated difference, that is, without coordinating with each other. In each axis operation, the control unit 12 may operate the wrist joints J4, J5, and J6 in order or at the same time.
  • WCP wrist center point
  • WCP is a point where the axes A4, A5, and A6 of the wrist joints J4, J5, and J6 intersect each other.
  • the control point Pc moves from the first position P1 to the second position P2 while changing the posture (W, P, R) by each axis movement of the wrist joints J4, J5, J6, and the set posture ( W1, P1, R1) are arranged at the second position P2.
  • the control point Pc when the wrist portion 3 is arranged at the singular point or near the singular point at the second position P2, the control point Pc is set to the second by the movement of each axis of the wrist joints J4, J5, J6. Move to position P2. Since the wrist joints J4, J5, and J6 operate without coordinating with each other in each axial movement, the control point Pc moves while changing the posture. That is, while the control point Pc moves from the first position P1 to the second position P2, the wrist portion 3 is arranged in a posture different from the singular point. Therefore, the control point Pc can be moved from the first position P1 to the second position P2 while preventing the wrist portion 3 from being arranged at the singular point or near the singular point.
  • the robot 2 may be placed at the singular point.
  • an error occurs due to a sudden movement of a specific joint, and the robot 2 stops.
  • the operator must reset the second position P2 so that the robot 2 does not pass through the singular point.
  • it is automatically determined whether or not the wrist portion 3 is arranged at the singular point, and it is automatically avoided that the posture of the wrist portion 3 is arranged at the singular point or near the singular point. While the control point Pc moves from the first position P1 to the second position P2. Therefore, it is possible to prevent the occurrence of an error and smoothly teach the robot 2.
  • control point Pc moves to the second position P2
  • the WCP moves linearly due to the linear motion of the basic joints J1, J2, and J3. Therefore, even if the wrist joints J4, J5, and J6 perform their respective axial movements, the position of the control point Pc does not deviate significantly from the linear orbit T, and the orbit of the control point Pc becomes an orbit close to the linear orbit T. .. Therefore, the control point Pc can be moved along a trajectory that is substantially the same as the linear trajectory T intended by the operator.
  • the robot control device 1 may further include a notification unit 13 for notifying when the distance from the linear trajectory T to the control point Pc exceeds a predetermined threshold value.
  • the operator recognizes that the position of the control point Pc exceeds the threshold value and deviates from the linear trajectory T based on the notification by the notification unit 13, and if necessary, sets the first position P1 and the second position P2 to others. Can be reset to the position of.
  • control unit 12 calculates and controls the three-dimensional position of the control point Pc from the rotation angles of the joints J1 to J6 detected by the encoder while the wrist joints J4, J5, and J6 are operated on each axis.
  • the distance of the point Pc from the straight orbit T is calculated.
  • the notification unit 13 notifies the operator that the distance has exceeded the threshold value, for example, by emitting a warning sound.
  • the control unit 12 may stop the operation of the robot 2 when the distance exceeds the threshold value.
  • the control unit 12 when the posture of the wrist portion 3 when the control point Pc is located at the second position P2 is a singular point, the control unit 12 holds the position of the control point Pc on the straight line trajectory T and the wrist.
  • the control point Pc By operating the joints J4, J5, and J6 on each axis, the control point Pc may be moved to the second position P2 on the straight line trajectory T while changing the posture of the control point Pc. According to this configuration, the control point Pc can be moved along the same linear trajectory T as in the linear operation while preventing the wrist portion 3 from being arranged at the singular point.
  • the control unit 12 decides to operate the basic joints J1, J2, and J3 linearly. If there is no problem even if the trajectory of the control point Pc from the first position P1 to the second position P2 deviates significantly from the linear trajectory T, the basic joints J1, J2, and J3 may also be operated on each axis.
  • the robot 2 is a 6-axis vertical articulated robot, but the robot 2 may be a vertical articulated robot having another number of axes or a robot having another joint configuration.
  • Robot control device 2 Robot 3 Wrist 8 End effector 11 Storage unit (location information recording unit) 12 Control unit 13 Notification unit J1, J2, J3 Basic joint J4, J5, J6 Wrist joint P1 1st position P2 2nd position Pc Control point S Singular point region T Straight trajectory

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • General Health & Medical Sciences (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Human Computer Interaction (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

ロボット制御装置（１）は、複数の基本関節および複数の手首関節を制御することによって制御点（Ｐｃ）を第１位置（Ｐ１）から第２位置（Ｐ２）まで移動させる制御部と、第２位置（Ｐ２）の位置と制御点（Ｐｃ）が第２位置（Ｐ２）に位置するときの複数の手首関節の各々の回転角度とを含む位置情報を記録する位置情報記録部とを備え、制御部は、制御点（Ｐｃ）が第２位置（Ｐ２）に位置するときの手首部（３）の姿勢が特異点でない場合、複数の基本関節および複数の手首関節を相互に協調させて直線動作させることによって制御点（Ｐｃ）を第２位置（Ｐ２）まで直線移動させ、制御点（Ｐｃ）が第２位置（Ｐ２）に位置するときの手首部（３）の姿勢が特異点である場合、複数の手首関節を相互に協調させずに各軸動作させることによって制御点（Ｐｃ）を第２位置（Ｐ２）まで移動させる。

Description

ロボット制御装置
　本発明は、ロボット制御装置に関するものである。
　従来、複数の関節を協調させて動作させることによってロボットの所定の部位を所定の連続軌道に沿って移動させる多関節のロボットの制御方法が知られている（例えば、特許文献１～４参照。）。例えば、第１位置および第２位置が教示され、第１位置から第２位置までの直線軌道上をＴＣＰ（ｔｏｏｌ　ｃｅｎｔｅｒ　ｐｏｉｎｔ）のような制御点が直線移動するように複数の関節が制御される。
特開２０１８－１１１１５５号公報 国際公開第２０１６/１３５８６１号 国際公開第２０１７/００２２０８号 特開２０１５－０６６６６８号公報
　連続軌道に沿って動作しているとき、ロボットの姿勢が特異点に近付き、少なくとも１つの関節が急激に動作することがある。このような場合、ロボット制御装置は、エラーが発生したと判定し、ロボットの動作を停止させる等の処置を取る。したがって、エラーが発生する度に、別の軌道を再教示してロボットを再動作させる等の追加の作業が必要となる。
　本開示の一態様は、多関節のロボットを制御するロボット制御装置であって、前記ロボットが、手首部の位置を変化させる複数の基本関節と、前記手首部または該手首部に接続されたエンドエフェクタに設定された制御点の位置および姿勢を変化させる複数の手首関節とを有し、前記複数の基本関節および前記複数の手首関節を制御することによって、前記制御点を第１位置から第２位置まで移動させる制御部と、前記第２位置の位置と前記制御点が前記第２位置に位置するときの前記複数の手首関節の各々の回転角度とを含む位置情報を記録する位置情報記録部と、を備え、前記制御点が前記第２位置に位置するときの前記手首部の姿勢が特異点でない場合、前記制御部は、前記複数の基本関節および前記複数の手首関節を相互に協調させて直線動作させることによって、前記制御点を前記第２位置まで直線移動させ、前記制御点が前記第２位置に位置するときの前記手首部の姿勢が特異点である場合、前記制御部は、前記複数の手首関節を相互に協調させずに各軸動作させることによって、前記制御点を前記第２位置まで移動させる、ロボット制御装置である。
ロボット制御装置によって制御されるロボットの構成図である。 ロボット制御装置のブロック図である。 第１位置から第２位置までの制御点の軌道の他の例を示す図である。
　以下に、一実施形態に係るロボット制御装置について図面を参照して説明する。
　図１および図２に示されるように、ロボット制御装置１は、手首部３を備える多関節のロボット２に接続され、ロボット２を制御するものである。
　ロボット２は、手首部３の位置を３次元的に変化させる複数の基本関節Ｊ１，Ｊ２，Ｊ３と、制御点Ｐｃの位置（Ｘ，Ｙ，Ｚ）および姿勢（Ｗ，Ｐ，Ｒ）を３次元的に変化させる複数の手首関節Ｊ４，Ｊ５，Ｊ６とを備える。制御点Ｐｃは、手首部３の所定の位置に設定された点、または、手首部３に接続されたエンドエフェクタ８の所定の位置に設定された点である。例えば、制御点Ｐｃは、手首部３の先端面３ａの中心点、または、ＴＣＰ（ｔｏｏｌ　ｃｅｎｔｅｒ　ｐｏｉｎｔ）である。
　本実施形態において、ロボット２は、６つの関節Ｊ１～Ｊ６を有する６軸の垂直多関節ロボットである。ロボット２は、床に固定されるベース４と、ベース４上に配置された旋回胴５と、旋回胴５と連結された第１アーム６と、第１アーム６の先端に連結された第２アーム７とを備える。手首部３は、第２アーム７の先端に連結され、ハンドまたはツール等のエンドエフェクタ８を取り付け可能な先端面３ａを有する。
　各関節Ｊ１～Ｊ６には、ロボット制御装置１からの制御指令に従って各関節Ｊ１～Ｊ６を駆動するサーボモータ、および、各関節Ｊ１～Ｊ６の回転角度を検出するエンコーダが設けられている。
　基本関節は、第１関節Ｊ１、第２関節Ｊ２および第３関節Ｊ３である。第１関節Ｊ１は、旋回胴５を鉛直方向の第１軸線Ａ１回りにベース４に対して回転させる。第２関節Ｊ２は、第１アーム６を水平な第２軸線Ａ２回りに旋回胴５に対して回転させる。第３関節Ｊ３は、第２アーム７を水平な第３軸線Ａ３回りに第１アーム６に対して回転させる。
　手首関節は、第４関節Ｊ４、第５関節Ｊ５および第６関節Ｊ６である。第４関節Ｊ４は、第２アーム７を第４軸線Ａ４回りに第１アーム６に対して回転させる。第５関節Ｊ５は、手首部３を第５軸線Ａ５回りに第２アーム７に対して回転させる。第６関節Ｊ６は、手首部３の先端面３ａを第６軸線Ａ６回りに回転させる。第４軸線Ａ４は第２アーム７の長手軸に沿って延び、第５軸線Ａ５は第４軸線Ａ４に直交し、第６軸線Ａ６は第５軸線Ａ５に直交する。
　図２に示されるように、ロボット制御装置１は、記憶部１１と、制御部１２とを備える。
　記憶部１１は、ＲＡＭ（random　access　memory）、ＲＯＭ（read-only memory）およびＨＤＤ（hard　disc　drive）等の記憶装置を有する。ロボット制御装置１には、中央演算処理装置のような少なくとも１つのプロセッサが設けられている。記憶部１１には、制御部１２の後述の処理をプロセッサに実行させるための制御プログラムが記憶されている。すなわち、制御部１２は、少なくとも１つのプロセッサによって実現される。
　制御部１２は、第１位置Ｐ１と第２位置Ｐ２との間を直線補間することによって、第１位置Ｐ１から第２位置Ｐ２まで真っすぐに延びる直線軌道Ｔを算出する。第１位置Ｐ１および第２位置Ｐ２は、操作者によって設定される任意の３次元位置であり、例えば、ダイレクトティーチ等の教示作業において教示される教示点である。
　制御部１２は、関節Ｊ１～Ｊ６を制御することによって、制御点Ｐｃを第１位置Ｐ１から第２位置Ｐ２まで移動させる。
　制御点Ｐｃの移動に先立ち、制御部１２は、制御点Ｐｃが設定された姿勢で第２位置Ｐ２に位置するときの手首関節Ｊ４，Ｊ５，Ｊ６の各々の回転角度を逆運動学によって算出する。制御点Ｐｃの姿勢（先端面３ａの姿勢）は、第１位置Ｐ１および第２位置Ｐ２と同様に、操作者によって設定される。算出された手首関節Ｊ４，Ｊ５，Ｊ６の各々の回転角度と、第２位置Ｐ２の３次元の位置（Ｘ２，Ｙ２，Ｚ２）とを含む位置情報は、記憶部（位置情報記録部）１１に記憶（記録）される。
　制御部１２は、制御点Ｐｃが第２位置Ｐ２に位置するときの手首部３の姿勢が特異点または特異点近傍であるか否かを判定する。次に、制御部１２は、判定結果に応じて関節Ｊ１～Ｊ６を直線動作または各軸動作させることによって、制御点Ｐｃを第１位置Ｐ１から第２位置まで移動させる。制御部１２による関節Ｊ１～Ｊ６の制御方法については、後で詳述する。
　参照する図面において、領域Ｓは、手首部３の姿勢が特異点または特異点近傍に配置される特異点領域を示している。本実施形態において、特異点は、第４軸線Ａ４と第６軸線Ａ６とが一直線上に配置される姿勢である。手首部３の姿勢が特異点であるとき、手首部３の動作を制御することができなくなる。
　例えば、制御部１２は、記憶部１１に記憶されている位置情報に基づいて、制御点Ｐｃが第２位置Ｐ２に位置するときの第４軸線Ａ４と第６軸線Ａ６との間の回転角度θを算出する。そして、制御部１２は、回転角度θの大きさが所定の閾値以下、例えば５°以下であるとき、制御点Ｐｃが第２位置Ｐ２に位置するときの手首部３の姿勢が特異点または特異点近傍であると判定する。
　次に、ロボット制御装置１の作用について説明する。
　例えば、制御点Ｐｃの軌道をロボット制御装置１に教示するとき、操作者は、第１位置Ｐ１（Ｘ１，Ｙ１，Ｚ１）および第２位置Ｐ２（Ｘ２，Ｙ２，Ｚ２）を教示位置として設定し、制御点Ｐｃの姿勢（Ｗ１，Ｐ１，Ｒ１）を教示姿勢として設定する。第１位置Ｐ１（Ｘ１，Ｙ１，Ｚ１）、第２位置Ｐ２（Ｘ２，Ｙ２，Ｚ２）および姿勢（Ｗ１，Ｐ１，Ｒ１）は、記憶部１１に記憶される。
　次に、制御部１２によって、制御点Ｐｃが設定された姿勢（Ｗ１，Ｐ１，Ｒ１）で第２位置Ｐ２に位置するときの手首部３の姿勢が特異点であるか否かが判定される。次に、制御部１２によって関節Ｊ１～Ｊ６が制御され、関節Ｊ１～Ｊ６の直線動作または各軸動作によって制御点Ｐｃが第１位置Ｐ１から第２位置Ｐ２まで移動する。
　制御点Ｐｃが第２位置Ｐ２に位置するときの手首部３の姿勢が特異点でない場合、制御部１２は、関節Ｊ１～Ｊ６を相互に協調させて直線動作させることによって、制御点Ｐｃを、姿勢（Ｗ１，Ｐ１，Ｒ１）を保持しながら第１位置Ｐ１（Ｘ１，Ｙ１，Ｚ１）から第２位置Ｐ２（Ｘ２，Ｙ２，Ｚ２）まで直線軌道Ｔに沿って直線移動させる。具体的には、制御部１２は、制御点Ｐｃが設定された姿勢（Ｗ１，Ｐ１，Ｒ１）で直線軌道Ｔ上の各位置に位置するときの各関節Ｊ１～Ｊ６の回転角度を逆運動学によって算出し、制御点Ｐｃを第１位置Ｐ１から第２位置Ｐ２まで姿勢（Ｗ１，Ｐ１，Ｒ１）を保持しながら直線移動させるための回転角度の時系列のデータを得る。次に、制御部１２は、算出された角度の時系列のデータに従って関節Ｊ１～Ｊ６を制御する。
　一方、制御点Ｐｃが第２位置Ｐ２に位置するときの手首部３の姿勢が特異点である場合、制御部１２は、基本関節Ｊ１，Ｊ２，Ｊ３を直線動作させながら手首関節Ｊ４，Ｊ５，Ｊ６を各軸動作させることによって、制御点Ｐｃを第１位置Ｐ１から第２位置Ｐ２まで移動させる。基本関節Ｊ１，Ｊ２，Ｊ３の直線動作は、前述の方法で得られた各関節Ｊ１，Ｊ２，Ｊ３の回転角度の時系列のデータに従って関節Ｊ１，Ｊ２，Ｊ３を制御することによって行われる。
　各軸動作において、制御部１２は、制御点Ｐｃが設定された姿勢（Ｗ１，Ｐ１，Ｒ１）で第１位置Ｐ１に位置するときの各手首関節Ｊ４，Ｊ５，Ｊ６の回転角度と、制御点Ｐｃが設定された姿勢（Ｗ１，Ｐ１，Ｒ１）で第２位置Ｐ２に位置するときの各手首関節Ｊ４，Ｊ５，Ｊ６の回転角度との差分を算出する。次に、制御部１２は、各手首関節Ｊ４，Ｊ５，Ｊ６を、算出された差分だけ個別に、すなわち相互に協調させずに動作させる。各軸動作において、制御部１２は、手首関節Ｊ４，Ｊ５，Ｊ６を順番に動作させてもよく、同時に動作させてもよい。
　基本関節Ｊ１，Ｊ２，Ｊ３の直線動作によって、手首中心点（ＷＣＰ）は直線軌道Ｔに平行な軌道Ｔ’に沿って直線移動する。ＷＣＰは、手首関節Ｊ４，Ｊ５，Ｊ６の軸線Ａ４，Ａ５，Ａ６が相互に交差する点である。また、手首関節Ｊ４，Ｊ５，Ｊ６の各軸動作によって、制御点Ｐｃは、姿勢（Ｗ，Ｐ，Ｒ）を変化させながら第１位置Ｐ１から第２位置Ｐ２まで移動し、設定された姿勢（Ｗ１，Ｐ１，Ｒ１）で第２位置Ｐ２に配置される。
　このように、本実施形態によれば、第２位置Ｐ２において手首部３が特異点または特異点近傍に配置される場合、手首関節Ｊ４，Ｊ５，Ｊ６の各軸動作によって制御点Ｐｃが第２位置Ｐ２まで移動する。各軸動作において手首関節Ｊ４，Ｊ５，Ｊ６は相互に協調せずに動作するので、制御点Ｐｃは、姿勢を変化させながら移動する。つまり、制御点Ｐｃが第１位置Ｐ１から第２位置Ｐ２まで移動する間、手首部３は特異点とは異なる姿勢に配置される。したがって、手首部３が特異点または特異点近傍に配置されることを防止しながら、制御点Ｐｃを第１位置Ｐ１から第２位置Ｐ２まで移動させることができる。
　操作者にとって、動作しているロボット２の特異点を認識することは難しく、ロボット２が特異点に配置されてしまうことがある。ロボット２が特異点に配置されると、特定の関節の急激な動作によってエラーが生じ、ロボット２が停止してしまう。この場合、操作者は、ロボット２が特異点を通らないように第２位置Ｐ２を再設定しなければならない。このような作業は、操作者にとって煩わしく、作業効率が悪い。本実施形態によれば、手首部３が特異点に配置されるか否かが自動的に判定され、手首部３の姿勢が特異点または特異点近傍に配置されることを自動的に回避しながら制御点Ｐｃが第１位置Ｐ１から第２位置Ｐ２まで移動する。したがって、エラーの発生を防止し、ロボット２の教示をスムーズに行うことができる。
　また、制御点Ｐｃが第２位置Ｐ２まで移動している間、基本関節Ｊ１，Ｊ２，Ｊ３の直線動作によってＷＣＰは直線移動する。したがって、手首関節Ｊ４，Ｊ５，Ｊ６が各軸動作を行ったとしても、制御点Ｐｃの位置が直線軌道Ｔから大きく外れることはなく、制御点Ｐｃの軌道は、直線軌道Ｔに近い軌道となる。したがって、操作者が意図する直線軌道Ｔと大体同じ軌道に沿って制御点Ｐｃを移動させることができる。
　本実施形態において、ロボット制御装置１は、直線軌道Ｔから制御点Ｐｃまでの距離が所定の閾値を超えたときにその旨を報知する報知部１３をさらに備えていてもよい。操作者は、制御点Ｐｃの位置が閾値を超えて直線軌道Ｔから外れたことを、報知部１３による報知に基づいて認識し、必要に応じて、第１位置Ｐ１および第２位置Ｐ２を他の位置へ再設定することができる。
　例えば、制御部１２は、手首関節Ｊ４，Ｊ５，Ｊ６を各軸動作させている間、制御点Ｐｃの３次元の位置をエンコーダによって検出された各関節Ｊ１～Ｊ６の回転角度から計算し、制御点Ｐｃの直線軌道Ｔからの距離を計算する。算出される距離が閾値を超えたとき、報知部１３は、例えば警告音を発することによって、距離が閾値を超えたことを操作者に報知する。制御部１２は、距離が閾値を超えたとき、ロボット２の動作を停止させてもよい。
　本実施形態において、制御点Ｐｃが第２位置Ｐ２に位置するときの手首部３の姿勢が特異点である場合、制御部１２は、制御点Ｐｃの位置を直線軌道Ｔ上に保持しながら手首関節Ｊ４、Ｊ５，Ｊ６を各軸動作させることによって、制御点Ｐｃの姿勢を変化させながら制御点Ｐｃを第２位置Ｐ２まで直線軌道Ｔ上で移動させてもよい。
　この構成によれば、手首部３が特異点に配置されることを防ぎつつ、直線動作のときと同じ直線軌道Ｔに沿って制御点Ｐｃを移動させることができる。
　本実施形態において、制御点Ｐｃが第２位置Ｐ２に位置するときの手首部３の姿勢が特異点である場合、制御部１２が、基本関節Ｊ１，Ｊ２，Ｊ３を直線動作させることとしたが、第１位置Ｐ１から第２位置Ｐ２までの制御点Ｐｃの軌道が直線軌道Ｔから大きく外れても問題ない場合、基本関節Ｊ１，Ｊ２，Ｊ３も各軸動作させてもよい。
　本実施形態において、ロボット２が６軸の垂直多関節ロボットであることとしたが、ロボット２は他の軸数の垂直多関節ロボットまたは他の関節構成のロボットであってもよい。
　１　ロボット制御装置
　２　ロボット
　３　手首部
　８　エンドエフェクタ
　１１　記憶部（位置情報記録部）
　１２　制御部
　１３　報知部
　Ｊ１，Ｊ２，Ｊ３　基本関節
　Ｊ４，Ｊ５，Ｊ６　手首関節
　Ｐ１　第１位置
　Ｐ２　第２位置
　Ｐｃ　制御点
　Ｓ　特異点領域
　Ｔ　直線軌道

Claims (3)

  1. 　多関節のロボットを制御するロボット制御装置であって、前記ロボットが、手首部の位置を変化させる複数の基本関節と、前記手首部または該手首部に接続されたエンドエフェクタに設定された制御点の位置および姿勢を変化させる複数の手首関節とを有し、
    　前記複数の基本関節および前記複数の手首関節を制御することによって前記制御点を第１位置から第２位置まで移動させる制御部と、
    　前記第２位置の位置と、前記制御点が前記第２位置に位置するときの前記複数の手首関節の各々の回転角度と、を含む位置情報を記録する位置情報記録部と、を備え、
    　前記制御点が前記第２位置に位置するときの前記手首部の姿勢が特異点でない場合、前記制御部は、前記複数の基本関節および前記複数の手首関節を相互に協調させて直線動作させることによって、前記制御点を前記第２位置まで直線移動させ、
    　前記制御点が前記第２位置に位置するときの前記手首部の姿勢が特異点である場合、前記制御部は、前記複数の手首関節を相互に協調させずに各軸動作させることによって、前記制御点を前記第２位置まで移動させる、ロボット制御装置。
  2. 　前記制御点が前記第２位置に位置するときの前記手首部の姿勢が特異点である場合、前記制御部は、前記制御点の位置を前記第１位置と前記第２位置とを結ぶ直線軌道上に保持しながら前記複数の手首関節の各軸動作させることによって、前記制御点を前記直線軌道上で前記第２位置まで移動させる、請求項１に記載のロボット制御装置。
  3. 　前記第１位置と前記第２位置とを結ぶ直線軌道からの前記制御点の距離が所定の閾値を超えたときにその旨を報知する報知部を備える請求項１または請求項２に記載のロボット制御装置。
PCT/JP2021/030483 2020-08-21 2021-08-20 ロボット制御装置 WO2022039245A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN202180050474.5A CN115943019A (zh) 2020-08-21 2021-08-20 机器人控制装置
JP2022544008A JP7469482B2 (ja) 2020-08-21 2021-08-20 ロボット制御装置
DE112021003148.1T DE112021003148T5 (de) 2020-08-21 2021-08-20 Robotersteuervorrichtung
US18/015,268 US20230256598A1 (en) 2020-08-21 2021-08-20 Robot controller

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020-140085 2020-08-21
JP2020140085 2020-08-21

Publications (1)

Publication Number Publication Date
WO2022039245A1 true WO2022039245A1 (ja) 2022-02-24

Family

ID=80323519

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/030483 WO2022039245A1 (ja) 2020-08-21 2021-08-20 ロボット制御装置

Country Status (5)

Country Link
US (1) US20230256598A1 (ja)
JP (1) JP7469482B2 (ja)
CN (1) CN115943019A (ja)
DE (1) DE112021003148T5 (ja)
WO (1) WO2022039245A1 (ja)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04169909A (ja) * 1990-11-01 1992-06-17 Fanuc Ltd ロボットの姿勢修正方法
JPH11226886A (ja) * 1998-02-13 1999-08-24 Hitachi Zosen Corp ロボット軌道の修正方法
JP2018027580A (ja) * 2016-08-17 2018-02-22 ファナック株式会社 ロボット制御装置

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6359756B2 (ja) 2015-02-24 2018-07-18 株式会社日立製作所 マニプレータ、マニプレータの動作計画方法、および、マニプレータの制御システム
WO2017002208A1 (ja) 2015-06-30 2017-01-05 株式会社安川電機 ロボットシステム

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04169909A (ja) * 1990-11-01 1992-06-17 Fanuc Ltd ロボットの姿勢修正方法
JPH11226886A (ja) * 1998-02-13 1999-08-24 Hitachi Zosen Corp ロボット軌道の修正方法
JP2018027580A (ja) * 2016-08-17 2018-02-22 ファナック株式会社 ロボット制御装置

Also Published As

Publication number Publication date
US20230256598A1 (en) 2023-08-17
DE112021003148T5 (de) 2023-05-04
JPWO2022039245A1 (ja) 2022-02-24
CN115943019A (zh) 2023-04-07
JP7469482B2 (ja) 2024-04-16

Similar Documents

Publication Publication Date Title
KR101644758B1 (ko) 관절형 로봇을 위한 이벤트 기반의 여유 각도 구성
JP6279862B2 (ja) 冗長ロボットを制御する方法
US10836042B2 (en) Robot system
KR101683289B1 (ko) 매니퓰레이터를 조절하기 위한 방법 및 장치
CN108858183B (zh) 机器人、机器人的控制方法、工件的制造方法
JP2021053802A (ja) 産業用ロボットおよびその運転方法
KR101581096B1 (ko) 다관절형 로봇의 제어 장치, 제어 방법 및 제어 프로그램을 기록한 컴퓨터 판독가능한 기록 매체
US6845295B2 (en) Method of controlling a robot through a singularity
US20110224815A1 (en) Industrial Robot And Path Planning Method For Controlling The Movement Of An Industrial Robot
JP6746990B2 (ja) ロボット制御装置及びロボットシステム
JP4262715B2 (ja) ロボットのティーチングデータ作成方法
JP5078770B2 (ja) 多関節ロボットのティーチングデータ検証方法
JP7144754B2 (ja) 多関節ロボットおよび多関節ロボットシステム
WO2022039245A1 (ja) ロボット制御装置
JP7199073B2 (ja) 垂直多関節ロボットの教示データ作成システム
JPH10240323A (ja) 移動ロボットの異常動作防止方法
JP4354608B2 (ja) 溶接用ロボットの教示方法及び装置
JP2017127932A (ja) ロボット装置、ロボット制御方法、部品の製造方法、プログラム及び記録媒体
JP4206097B2 (ja) ロボットのティーチングデータ作成方法
JP6941305B2 (ja) 嵌合装置、嵌合方法及びプログラム
JP4647919B2 (ja) 制御方法および制御装置
WO2023135762A1 (ja) 制御装置、教示装置、及び機械システム
JP7424097B2 (ja) ロボットの制御装置及びロボットの制御方法
EP4364901A1 (en) Micromanipulator
JP4000307B2 (ja) 多関節ロボットのティーチングデータ作成方法

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21858388

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2022544008

Country of ref document: JP

Kind code of ref document: A

122 Ep: pct application non-entry in european phase

Ref document number: 21858388

Country of ref document: EP

Kind code of ref document: A1