WO2022039245A1 - ロボット制御装置 - Google Patents
ロボット制御装置 Download PDFInfo
- 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
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
ロボット制御装置(1)は、複数の基本関節および複数の手首関節を制御することによって制御点(Pc)を第1位置(P1)から第2位置(P2)まで移動させる制御部と、第2位置(P2)の位置と制御点(Pc)が第2位置(P2)に位置するときの複数の手首関節の各々の回転角度とを含む位置情報を記録する位置情報記録部とを備え、制御部は、制御点(Pc)が第2位置(P2)に位置するときの手首部(3)の姿勢が特異点でない場合、複数の基本関節および複数の手首関節を相互に協調させて直線動作させることによって制御点(Pc)を第2位置(P2)まで直線移動させ、制御点(Pc)が第2位置(P2)に位置するときの手首部(3)の姿勢が特異点である場合、複数の手首関節を相互に協調させずに各軸動作させることによって制御点(Pc)を第2位置(P2)まで移動させる。
Description
本発明は、ロボット制御装置に関するものである。
従来、複数の関節を協調させて動作させることによってロボットの所定の部位を所定の連続軌道に沿って移動させる多関節のロボットの制御方法が知られている(例えば、特許文献1~4参照。)。例えば、第1位置および第2位置が教示され、第1位置から第2位置までの直線軌道上をTCP(tool center point)のような制御点が直線移動するように複数の関節が制御される。
連続軌道に沿って動作しているとき、ロボットの姿勢が特異点に近付き、少なくとも1つの関節が急激に動作することがある。このような場合、ロボット制御装置は、エラーが発生したと判定し、ロボットの動作を停止させる等の処置を取る。したがって、エラーが発生する度に、別の軌道を再教示してロボットを再動作させる等の追加の作業が必要となる。
本開示の一態様は、多関節のロボットを制御するロボット制御装置であって、前記ロボットが、手首部の位置を変化させる複数の基本関節と、前記手首部または該手首部に接続されたエンドエフェクタに設定された制御点の位置および姿勢を変化させる複数の手首関節とを有し、前記複数の基本関節および前記複数の手首関節を制御することによって、前記制御点を第1位置から第2位置まで移動させる制御部と、前記第2位置の位置と前記制御点が前記第2位置に位置するときの前記複数の手首関節の各々の回転角度とを含む位置情報を記録する位置情報記録部と、を備え、前記制御点が前記第2位置に位置するときの前記手首部の姿勢が特異点でない場合、前記制御部は、前記複数の基本関節および前記複数の手首関節を相互に協調させて直線動作させることによって、前記制御点を前記第2位置まで直線移動させ、前記制御点が前記第2位置に位置するときの前記手首部の姿勢が特異点である場合、前記制御部は、前記複数の手首関節を相互に協調させずに各軸動作させることによって、前記制御点を前記第2位置まで移動させる、ロボット制御装置である。
以下に、一実施形態に係るロボット制御装置について図面を参照して説明する。
図1および図2に示されるように、ロボット制御装置1は、手首部3を備える多関節のロボット2に接続され、ロボット2を制御するものである。
ロボット2は、手首部3の位置を3次元的に変化させる複数の基本関節J1,J2,J3と、制御点Pcの位置(X,Y,Z)および姿勢(W,P,R)を3次元的に変化させる複数の手首関節J4,J5,J6とを備える。制御点Pcは、手首部3の所定の位置に設定された点、または、手首部3に接続されたエンドエフェクタ8の所定の位置に設定された点である。例えば、制御点Pcは、手首部3の先端面3aの中心点、または、TCP(tool center point)である。
図1および図2に示されるように、ロボット制御装置1は、手首部3を備える多関節のロボット2に接続され、ロボット2を制御するものである。
ロボット2は、手首部3の位置を3次元的に変化させる複数の基本関節J1,J2,J3と、制御点Pcの位置(X,Y,Z)および姿勢(W,P,R)を3次元的に変化させる複数の手首関節J4,J5,J6とを備える。制御点Pcは、手首部3の所定の位置に設定された点、または、手首部3に接続されたエンドエフェクタ8の所定の位置に設定された点である。例えば、制御点Pcは、手首部3の先端面3aの中心点、または、TCP(tool center point)である。
本実施形態において、ロボット2は、6つの関節J1~J6を有する6軸の垂直多関節ロボットである。ロボット2は、床に固定されるベース4と、ベース4上に配置された旋回胴5と、旋回胴5と連結された第1アーム6と、第1アーム6の先端に連結された第2アーム7とを備える。手首部3は、第2アーム7の先端に連結され、ハンドまたはツール等のエンドエフェクタ8を取り付け可能な先端面3aを有する。
各関節J1~J6には、ロボット制御装置1からの制御指令に従って各関節J1~J6を駆動するサーボモータ、および、各関節J1~J6の回転角度を検出するエンコーダが設けられている。
各関節J1~J6には、ロボット制御装置1からの制御指令に従って各関節J1~J6を駆動するサーボモータ、および、各関節J1~J6の回転角度を検出するエンコーダが設けられている。
基本関節は、第1関節J1、第2関節J2および第3関節J3である。第1関節J1は、旋回胴5を鉛直方向の第1軸線A1回りにベース4に対して回転させる。第2関節J2は、第1アーム6を水平な第2軸線A2回りに旋回胴5に対して回転させる。第3関節J3は、第2アーム7を水平な第3軸線A3回りに第1アーム6に対して回転させる。
手首関節は、第4関節J4、第5関節J5および第6関節J6である。第4関節J4は、第2アーム7を第4軸線A4回りに第1アーム6に対して回転させる。第5関節J5は、手首部3を第5軸線A5回りに第2アーム7に対して回転させる。第6関節J6は、手首部3の先端面3aを第6軸線A6回りに回転させる。第4軸線A4は第2アーム7の長手軸に沿って延び、第5軸線A5は第4軸線A4に直交し、第6軸線A6は第5軸線A5に直交する。
図2に示されるように、ロボット制御装置1は、記憶部11と、制御部12とを備える。
記憶部11は、RAM(random access memory)、ROM(read-only memory)およびHDD(hard disc drive)等の記憶装置を有する。ロボット制御装置1には、中央演算処理装置のような少なくとも1つのプロセッサが設けられている。記憶部11には、制御部12の後述の処理をプロセッサに実行させるための制御プログラムが記憶されている。すなわち、制御部12は、少なくとも1つのプロセッサによって実現される。
記憶部11は、RAM(random access memory)、ROM(read-only memory)およびHDD(hard disc drive)等の記憶装置を有する。ロボット制御装置1には、中央演算処理装置のような少なくとも1つのプロセッサが設けられている。記憶部11には、制御部12の後述の処理をプロセッサに実行させるための制御プログラムが記憶されている。すなわち、制御部12は、少なくとも1つのプロセッサによって実現される。
制御部12は、第1位置P1と第2位置P2との間を直線補間することによって、第1位置P1から第2位置P2まで真っすぐに延びる直線軌道Tを算出する。第1位置P1および第2位置P2は、操作者によって設定される任意の3次元位置であり、例えば、ダイレクトティーチ等の教示作業において教示される教示点である。
制御部12は、関節J1~J6を制御することによって、制御点Pcを第1位置P1から第2位置P2まで移動させる。
制御部12は、関節J1~J6を制御することによって、制御点Pcを第1位置P1から第2位置P2まで移動させる。
制御点Pcの移動に先立ち、制御部12は、制御点Pcが設定された姿勢で第2位置P2に位置するときの手首関節J4,J5,J6の各々の回転角度を逆運動学によって算出する。制御点Pcの姿勢(先端面3aの姿勢)は、第1位置P1および第2位置P2と同様に、操作者によって設定される。算出された手首関節J4,J5,J6の各々の回転角度と、第2位置P2の3次元の位置(X2,Y2,Z2)とを含む位置情報は、記憶部(位置情報記録部)11に記憶(記録)される。
制御部12は、制御点Pcが第2位置P2に位置するときの手首部3の姿勢が特異点または特異点近傍であるか否かを判定する。次に、制御部12は、判定結果に応じて関節J1~J6を直線動作または各軸動作させることによって、制御点Pcを第1位置P1から第2位置まで移動させる。制御部12による関節J1~J6の制御方法については、後で詳述する。
参照する図面において、領域Sは、手首部3の姿勢が特異点または特異点近傍に配置される特異点領域を示している。本実施形態において、特異点は、第4軸線A4と第6軸線A6とが一直線上に配置される姿勢である。手首部3の姿勢が特異点であるとき、手首部3の動作を制御することができなくなる。
例えば、制御部12は、記憶部11に記憶されている位置情報に基づいて、制御点Pcが第2位置P2に位置するときの第4軸線A4と第6軸線A6との間の回転角度θを算出する。そして、制御部12は、回転角度θの大きさが所定の閾値以下、例えば5°以下であるとき、制御点Pcが第2位置P2に位置するときの手首部3の姿勢が特異点または特異点近傍であると判定する。
例えば、制御部12は、記憶部11に記憶されている位置情報に基づいて、制御点Pcが第2位置P2に位置するときの第4軸線A4と第6軸線A6との間の回転角度θを算出する。そして、制御部12は、回転角度θの大きさが所定の閾値以下、例えば5°以下であるとき、制御点Pcが第2位置P2に位置するときの手首部3の姿勢が特異点または特異点近傍であると判定する。
次に、ロボット制御装置1の作用について説明する。
例えば、制御点Pcの軌道をロボット制御装置1に教示するとき、操作者は、第1位置P1(X1,Y1,Z1)および第2位置P2(X2,Y2,Z2)を教示位置として設定し、制御点Pcの姿勢(W1,P1,R1)を教示姿勢として設定する。第1位置P1(X1,Y1,Z1)、第2位置P2(X2,Y2,Z2)および姿勢(W1,P1,R1)は、記憶部11に記憶される。
例えば、制御点Pcの軌道をロボット制御装置1に教示するとき、操作者は、第1位置P1(X1,Y1,Z1)および第2位置P2(X2,Y2,Z2)を教示位置として設定し、制御点Pcの姿勢(W1,P1,R1)を教示姿勢として設定する。第1位置P1(X1,Y1,Z1)、第2位置P2(X2,Y2,Z2)および姿勢(W1,P1,R1)は、記憶部11に記憶される。
次に、制御部12によって、制御点Pcが設定された姿勢(W1,P1,R1)で第2位置P2に位置するときの手首部3の姿勢が特異点であるか否かが判定される。次に、制御部12によって関節J1~J6が制御され、関節J1~J6の直線動作または各軸動作によって制御点Pcが第1位置P1から第2位置P2まで移動する。
制御点Pcが第2位置P2に位置するときの手首部3の姿勢が特異点でない場合、制御部12は、関節J1~J6を相互に協調させて直線動作させることによって、制御点Pcを、姿勢(W1,P1,R1)を保持しながら第1位置P1(X1,Y1,Z1)から第2位置P2(X2,Y2,Z2)まで直線軌道Tに沿って直線移動させる。具体的には、制御部12は、制御点Pcが設定された姿勢(W1,P1,R1)で直線軌道T上の各位置に位置するときの各関節J1~J6の回転角度を逆運動学によって算出し、制御点Pcを第1位置P1から第2位置P2まで姿勢(W1,P1,R1)を保持しながら直線移動させるための回転角度の時系列のデータを得る。次に、制御部12は、算出された角度の時系列のデータに従って関節J1~J6を制御する。
一方、制御点Pcが第2位置P2に位置するときの手首部3の姿勢が特異点である場合、制御部12は、基本関節J1,J2,J3を直線動作させながら手首関節J4,J5,J6を各軸動作させることによって、制御点Pcを第1位置P1から第2位置P2まで移動させる。基本関節J1,J2,J3の直線動作は、前述の方法で得られた各関節J1,J2,J3の回転角度の時系列のデータに従って関節J1,J2,J3を制御することによって行われる。
各軸動作において、制御部12は、制御点Pcが設定された姿勢(W1,P1,R1)で第1位置P1に位置するときの各手首関節J4,J5,J6の回転角度と、制御点Pcが設定された姿勢(W1,P1,R1)で第2位置P2に位置するときの各手首関節J4,J5,J6の回転角度との差分を算出する。次に、制御部12は、各手首関節J4,J5,J6を、算出された差分だけ個別に、すなわち相互に協調させずに動作させる。各軸動作において、制御部12は、手首関節J4,J5,J6を順番に動作させてもよく、同時に動作させてもよい。
基本関節J1,J2,J3の直線動作によって、手首中心点(WCP)は直線軌道Tに平行な軌道T’に沿って直線移動する。WCPは、手首関節J4,J5,J6の軸線A4,A5,A6が相互に交差する点である。また、手首関節J4,J5,J6の各軸動作によって、制御点Pcは、姿勢(W,P,R)を変化させながら第1位置P1から第2位置P2まで移動し、設定された姿勢(W1,P1,R1)で第2位置P2に配置される。
このように、本実施形態によれば、第2位置P2において手首部3が特異点または特異点近傍に配置される場合、手首関節J4,J5,J6の各軸動作によって制御点Pcが第2位置P2まで移動する。各軸動作において手首関節J4,J5,J6は相互に協調せずに動作するので、制御点Pcは、姿勢を変化させながら移動する。つまり、制御点Pcが第1位置P1から第2位置P2まで移動する間、手首部3は特異点とは異なる姿勢に配置される。したがって、手首部3が特異点または特異点近傍に配置されることを防止しながら、制御点Pcを第1位置P1から第2位置P2まで移動させることができる。
操作者にとって、動作しているロボット2の特異点を認識することは難しく、ロボット2が特異点に配置されてしまうことがある。ロボット2が特異点に配置されると、特定の関節の急激な動作によってエラーが生じ、ロボット2が停止してしまう。この場合、操作者は、ロボット2が特異点を通らないように第2位置P2を再設定しなければならない。このような作業は、操作者にとって煩わしく、作業効率が悪い。本実施形態によれば、手首部3が特異点に配置されるか否かが自動的に判定され、手首部3の姿勢が特異点または特異点近傍に配置されることを自動的に回避しながら制御点Pcが第1位置P1から第2位置P2まで移動する。したがって、エラーの発生を防止し、ロボット2の教示をスムーズに行うことができる。
また、制御点Pcが第2位置P2まで移動している間、基本関節J1,J2,J3の直線動作によってWCPは直線移動する。したがって、手首関節J4,J5,J6が各軸動作を行ったとしても、制御点Pcの位置が直線軌道Tから大きく外れることはなく、制御点Pcの軌道は、直線軌道Tに近い軌道となる。したがって、操作者が意図する直線軌道Tと大体同じ軌道に沿って制御点Pcを移動させることができる。
本実施形態において、ロボット制御装置1は、直線軌道Tから制御点Pcまでの距離が所定の閾値を超えたときにその旨を報知する報知部13をさらに備えていてもよい。操作者は、制御点Pcの位置が閾値を超えて直線軌道Tから外れたことを、報知部13による報知に基づいて認識し、必要に応じて、第1位置P1および第2位置P2を他の位置へ再設定することができる。
例えば、制御部12は、手首関節J4,J5,J6を各軸動作させている間、制御点Pcの3次元の位置をエンコーダによって検出された各関節J1~J6の回転角度から計算し、制御点Pcの直線軌道Tからの距離を計算する。算出される距離が閾値を超えたとき、報知部13は、例えば警告音を発することによって、距離が閾値を超えたことを操作者に報知する。制御部12は、距離が閾値を超えたとき、ロボット2の動作を停止させてもよい。
本実施形態において、制御点Pcが第2位置P2に位置するときの手首部3の姿勢が特異点である場合、制御部12は、制御点Pcの位置を直線軌道T上に保持しながら手首関節J4、J5,J6を各軸動作させることによって、制御点Pcの姿勢を変化させながら制御点Pcを第2位置P2まで直線軌道T上で移動させてもよい。
この構成によれば、手首部3が特異点に配置されることを防ぎつつ、直線動作のときと同じ直線軌道Tに沿って制御点Pcを移動させることができる。
この構成によれば、手首部3が特異点に配置されることを防ぎつつ、直線動作のときと同じ直線軌道Tに沿って制御点Pcを移動させることができる。
本実施形態において、制御点Pcが第2位置P2に位置するときの手首部3の姿勢が特異点である場合、制御部12が、基本関節J1,J2,J3を直線動作させることとしたが、第1位置P1から第2位置P2までの制御点Pcの軌道が直線軌道Tから大きく外れても問題ない場合、基本関節J1,J2,J3も各軸動作させてもよい。
本実施形態において、ロボット2が6軸の垂直多関節ロボットであることとしたが、ロボット2は他の軸数の垂直多関節ロボットまたは他の関節構成のロボットであってもよい。
本実施形態において、ロボット2が6軸の垂直多関節ロボットであることとしたが、ロボット2は他の軸数の垂直多関節ロボットまたは他の関節構成のロボットであってもよい。
1 ロボット制御装置
2 ロボット
3 手首部
8 エンドエフェクタ
11 記憶部(位置情報記録部)
12 制御部
13 報知部
J1,J2,J3 基本関節
J4,J5,J6 手首関節
P1 第1位置
P2 第2位置
Pc 制御点
S 特異点領域
T 直線軌道
2 ロボット
3 手首部
8 エンドエフェクタ
11 記憶部(位置情報記録部)
12 制御部
13 報知部
J1,J2,J3 基本関節
J4,J5,J6 手首関節
P1 第1位置
P2 第2位置
Pc 制御点
S 特異点領域
T 直線軌道
Claims (3)
- 多関節のロボットを制御するロボット制御装置であって、前記ロボットが、手首部の位置を変化させる複数の基本関節と、前記手首部または該手首部に接続されたエンドエフェクタに設定された制御点の位置および姿勢を変化させる複数の手首関節とを有し、
前記複数の基本関節および前記複数の手首関節を制御することによって前記制御点を第1位置から第2位置まで移動させる制御部と、
前記第2位置の位置と、前記制御点が前記第2位置に位置するときの前記複数の手首関節の各々の回転角度と、を含む位置情報を記録する位置情報記録部と、を備え、
前記制御点が前記第2位置に位置するときの前記手首部の姿勢が特異点でない場合、前記制御部は、前記複数の基本関節および前記複数の手首関節を相互に協調させて直線動作させることによって、前記制御点を前記第2位置まで直線移動させ、
前記制御点が前記第2位置に位置するときの前記手首部の姿勢が特異点である場合、前記制御部は、前記複数の手首関節を相互に協調させずに各軸動作させることによって、前記制御点を前記第2位置まで移動させる、ロボット制御装置。 - 前記制御点が前記第2位置に位置するときの前記手首部の姿勢が特異点である場合、前記制御部は、前記制御点の位置を前記第1位置と前記第2位置とを結ぶ直線軌道上に保持しながら前記複数の手首関節の各軸動作させることによって、前記制御点を前記直線軌道上で前記第2位置まで移動させる、請求項1に記載のロボット制御装置。
- 前記第1位置と前記第2位置とを結ぶ直線軌道からの前記制御点の距離が所定の閾値を超えたときにその旨を報知する報知部を備える請求項1または請求項2に記載のロボット制御装置。
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)
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6359756B2 (ja) | 2015-02-24 | 2018-07-18 | 株式会社日立製作所 | マニプレータ、マニプレータの動作計画方法、および、マニプレータの制御システム |
WO2017002208A1 (ja) | 2015-06-30 | 2017-01-05 | 株式会社安川電機 | ロボットシステム |
-
2021
- 2021-08-20 US US18/015,268 patent/US20230256598A1/en active Pending
- 2021-08-20 WO PCT/JP2021/030483 patent/WO2022039245A1/ja active Application Filing
- 2021-08-20 JP JP2022544008A patent/JP7469482B2/ja active Active
- 2021-08-20 CN CN202180050474.5A patent/CN115943019A/zh active Pending
- 2021-08-20 DE DE112021003148.1T patent/DE112021003148T5/de active Pending
Patent Citations (3)
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 |