Robot control method and robot control device

By determining the relationship between the robot arm's rotation direction and the direction of gravity, additional commands are input to the motor to prevent overshoot or undershoot when the robot arm stops. This solves the problem of high motor current consumption in the robot's standby state and improves motor energy efficiency.

CN119053412AActive Publication Date: 2024-11-29PANASONIC INTELLECTUAL PROPERTY MANAGEMENT CO LTD
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
CN202380037499.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Priority Date
2022-07-29
Filing Date
2023-07-18
Publication Date
2024-11-29
Estimated Expiration
2043-07-18

AI Technical Summary

Technical Problem

In existing technologies, when a robot is stationary, the motor consumes more current because it needs to overcome gravity and static friction. This is especially true when the robot is stopped for a short period of time, and the current reduction effect is not significant.

Method used

By determining the relationship between the rotation direction of the robot arm and the direction of gravity, additional commands are input to the motor to cause the robot arm to overshoot or not overshoot in the opposite direction of gravity when it stops. This results in the generation of torque after deducting static friction from gravity in the standby state, reducing the current consumption of the motor.

Benefits of technology

This effectively reduces the current consumption of the robot arm's motor in standby mode, improves the motor's energy efficiency, and reduces heat generation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119053412A_ABST
    Figure CN119053412A_ABST
Patent Text Reader

Abstract

Whether the rotation direction of the robot arm (63) immediately before the input of the stop position command ([theta] com) is a first direction (upper direction) opposite to the gravitational direction or a second direction (lower direction) identical to the gravitational direction is determined. When it is determined that the robot arm (63) is in the first direction (upper direction), an addition command is inputted to the motor (68) such that the robot arm (63) is brought closer to the standby position after overshooting in the first direction (upper direction), and when it is determined that the robot arm (63) is in the second direction (lower direction), the robot arm (63) is not brought closer to the standby position after overshooting in the second direction (lower direction).
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present disclosure relates to a control method of a robot and a control device of a robot. Background Art

[0002] Patent Document 1 discloses a robot control method that, when the robot stops for a given period of time or longer, slightly moves an axis on which a dynamic load is acting in the opposite direction of the load, then returns to its original position, and stops the robot.

[0003] Prior Art Literature

[0004] Patent Literature

[0005] Patent Document 1: Japanese Patent No. 3125946 Summary of the invention

[0006] When the robot is stopped after moving upward against gravity, static friction is applied in the direction opposite to the stopping direction, that is, in the direction of gravity. On the other hand, when the robot is stopped after moving downward along the direction of gravity, static friction is applied in the direction opposite to gravity.

[0007] However, when the robot is stopped, the motor needs to generate torque to counteract the gravity and static friction applied to the robot. Here, the torque generated by the motor is proportional to the motor current, so when the robot is stopped after moving upward, the current consumption will increase.

[0008] Therefore, in the disclosure of Patent Document 1, after confirming that the robot has been in a stopped state for a given time or longer, the robot is moved slightly to forcibly create a state where a load is transferred from the robot arm so that the load is balanced with the torque generated by the servo motor, thereby reducing power consumption and heat generation. However, when the robot is stopped for a short time, there is a problem that the effect of reducing the current consumption of the motor becomes small.

[0009] The present disclosure has been made in view of such a point, and an object of the present disclosure is to reduce the current consumption of the motor when the operation of the robot arm is stopped and the robot arm is in a standby state.

[0010] The first disclosure is a control method for a robot that uses a motor to move a robot arm, comprising: a step of inputting a position command to the motor to rotate the robot arm; a step of stopping the input of the position command to the motor; a step of determining whether the rotation direction of the robot arm immediately before stopping the input of the position command is a first direction (upward direction) that is opposite to the direction of gravity, or a second direction (downward direction) that is the same as the direction of gravity; and a step of inputting an additional command to the motor so that when it is determined that the rotation direction of the robot arm is the first direction (upward direction), the robot arm overshoots in the first direction (upward direction), and when it is determined that the rotation direction of the robot arm is the second direction (downward direction), the robot arm does not overshoot in the second direction (downward direction).

[0011] In the first disclosure, it is determined whether the rotation direction of the robot arm immediately before the input of the stop position command is the direction opposite to the gravity direction or the direction identical to the gravity direction. And, based on the determination result of the rotation direction of the robot arm, an additional command is input to the motor. Thus, it is possible to reduce the current consumption of the motor when the robot arm is stopped and in a standby state.

[0012] Specifically, when the rotation direction of the robot arm immediately before stopping is the first direction (upward direction), that is, the direction opposite to the gravity direction, static friction is applied in the direction opposite to the stopping direction, that is, in the gravity direction. Therefore, in the standby state of the robot, the motor needs to generate a torque obtained by adding the static friction to the gravity applied to the robot arm, and the current consumption of the motor increases.

[0013] On the other hand, when the rotation direction of the robot arm immediately before stopping is the second direction (downward direction), that is, the same direction as the gravity direction, static friction is applied in the direction opposite to the stopping direction, that is, the direction opposite to the gravity direction. Therefore, in the standby state of the robot, only a torque obtained by subtracting the static friction from the gravity applied to the robot arm is generated in the motor, and the current consumption of the motor is reduced.

[0014] Therefore, in the present disclosure, when the robot arm is set to a standby state after the movement of the robot arm is stopped, in a case where the rotation direction of the robot arm immediately before the stop is the first direction (upward direction), after the robot arm is overshot from the standby position to the first direction (upward direction), the robot arm is rotated toward the standby position in the same direction as the direction of gravity.

[0015] Furthermore, when the rotation direction of the robot arm immediately before stopping is the second direction (downward direction), the robot arm is rotated toward the standby position in the same direction as the gravity direction after preventing the robot arm from overshooting in the second direction (downward direction) from the standby position.

[0016] Thus, regardless of whether the rotation direction of the robot arm immediately before stopping is the first direction (upward direction) or the second direction (downward direction), a condition in which static friction is applied in the direction opposite to the direction of gravity can be created, similar to the case in which the robot arm is stopped after being rotated in the same direction as the direction of gravity. As a result, when the robot arm is set to the standby state, only a torque obtained by subtracting the static friction from the gravity applied to the robot arm is generated in the motor, and the current consumption of the motor can be reduced.

[0017] A second disclosure is a method for controlling a robot according to the first disclosure, further comprising: a step of gradually decreasing the additional command after the additional command is input to the motor.

[0018] In the second disclosure, the additional command is gradually reduced after the additional command is input to the motor, so that the robot arm can be gradually rotated toward the standby position in the same direction as the gravity direction.

[0019] A third disclosure is the robot control method according to the first disclosure, wherein the additional command is input to the motor immediately after the input of the position command is stopped.

[0020] In the third disclosure, since the additional command is input to the motor immediately after the stop position command is input, the power consumption of the motor can be reduced.

[0021] A fourth disclosure is the robot control method according to the first disclosure, wherein the additional command is input to the motor before the actual position of the robot arm reaches the standby position of the robot arm.

[0022] In the fourth disclosure, since an additional command is input to the motor before the actual position of the robot arm reaches the standby position of the robot arm, the power consumption of the motor can be reduced.

[0023] The fifth disclosure is a control device for a robot that uses a motor to move a robot arm, the control device performing: an action of inputting a position command to the motor to rotate the robot arm; an action of stopping the input of the position command to the motor; an action of determining whether the rotation direction of the robot arm immediately before stopping the input of the position command is a first direction (upward direction) that is opposite to the direction of gravity, or a second direction (downward direction) that is the same as the direction of gravity; and an action of inputting an additional command to the motor so that if it is determined to be the first direction (upward direction), the robot arm overshoots in the first direction (upward direction), and if it is determined to be the second direction (downward direction), the robot arm does not overshoot in the second direction (downward direction).

[0024] In the fifth disclosure, it is determined whether the rotation direction of the robot arm immediately before the input of the stop position command is the direction opposite to the gravity direction or the direction identical to the gravity direction. And, based on the determination result of the rotation direction of the robot arm, an additional command is input to the motor. Thus, it is possible to reduce the current consumption of the motor when the robot arm is stopped and in a standby state.

[0025] According to the present disclosure, it is possible to reduce the current consumption of the motor when the operation of the robot arm is stopped and the robot arm is in a standby state. BRIEF DESCRIPTION OF THE DRAWINGS

[0026] Figure 1 This is a schematic structural diagram of a vertical multi-joint 6-axis robot involved in this embodiment.

[0027] Figure 2 This is a schematic diagram of the robot mechanism.

[0028] Figure 3 This is a block diagram schematically showing the internal structure of a robot machine and a robot control device.

[0029] Figure 4 It is a block diagram of the robot drive control system.

[0030] Figure 5 This is a diagram showing a state where the tip of the robot arm is at the 0° position.

[0031] Figure 6 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque in Comparative Example 1.

[0032] Figure 7 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque in Comparative Example 2.

[0033] Figure 8 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque in Comparative Example 3.

[0034] Fig. 9 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque in Comparative Example 4.

[0035] Fig.10 This is a diagram showing the current consumption of the motor when the robot arm is stopped while ascending.

[0036] Fig.11 This is a diagram showing the current consumption of the motor when the robot arm is stopped while descending.

[0037] Fig.12 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque in Comparative Example 5.

[0038] Fig.13 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque in Comparative Example 6.

[0039] Fig.14 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque in Comparative Example 7.

[0040] Fig.15 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque in Comparative Example 8.

[0041] Fig.16 This is a flowchart showing the processing steps in the stop-time additional instruction operation module.

[0042] Fig.17 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque when an additional command is input after the robot arm is rotated to a 90° position in the direction opposite to the gravity direction.

[0043] Fig.18 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque when an additional command is input after the robot arm is rotated to a position of 270 degrees in the direction opposite to the gravity direction.

[0044] Fig.19 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque when an additional command is input after the robot arm is rotated to a 90° position in the same direction as the gravity direction.

[0045] Fig. 20 This is a diagram for explaining the relationship between the standby position of the robot arm and the motor torque when an additional command is input after the robot arm is rotated to a position of 270 degrees in the same direction as the gravity direction. DETAILED DESCRIPTION

[0046] Hereinafter, embodiments of the present disclosure will be described based on the drawings. Note that the following description of the preferred embodiments is merely illustrative in nature and is not intended to limit the present disclosure, its applications, or its uses.

[0047] <Structure of the robot and its control system>

[0048] like Figure 1 As shown in FIG. 6 , the robot 60 includes a robot mechanism 61 and a robot control device 62. The robot mechanism 61 includes a plurality of robot arms 63 and a plurality of joint axes 64. Figure 2 As shown, a motor 2 and a speed reducer 3 are provided near the joint shaft 64. The motor 2 and the speed reducer 3 are used to drive the robot mechanism 61.

[0049] like Figure 2As shown, in the robot machine 61, the first robot arm 1, the second robot arm 9, the motor 2 and the reducer 3 are mechanically connected. Figure 2 In the illustrated example, only a part of the robot machine 61 is schematically shown in order to make the description easier to understand.

[0050] The first robot arm 1 is a member that serves as a base for mounting the motor 2. The motor 2, the reducer 3, and the bearing 4 are fixed to the first robot arm 1. The second robot arm 9 as a load is coupled to the rotating portion of the secondary side 7 of the reducer, and the second robot arm 9 is driven. In addition, as the motor 2, for example, a servo motor can be used.

[0051] The primary side 6 of the speed reducer is coupled to the rotor 5 in the motor 2, and rotates at a given motor rotation speed ωM relative to the rotation axis of the motor 2. The speed reducer 3 reduces the motor rotation speed ωM to the load rotation speed ωL at a given reduction ratio Rg. The reduction ratio Rg is calculated by Rg=ωM / ωL.

[0052] In addition, there is a gap (clearance) and a spring component between the primary side 6 and the secondary side 7 of the reducer 3, and therefore the above-mentioned formula of the reduction ratio Rg is valid only when the primary side 6 and the secondary side 7 of the reducer are in contact and the gap (clearance) is biased to one side so that the extension of the spring becomes constant and stable.

[0053] like Figure 3 As shown, the robot control device 62 includes an operation / teaching unit 65 and a main control unit 66. The operation / teaching unit 65 stores, for example, the trajectories of the plurality of robot arms 63 acquired during teaching and the rotational motions of the motors 2 used to draw the trajectories.

[0054] The main control unit 66 receives instructions from the operation / teaching unit 65, and outputs position instructions θcom, θ1com to θ6com, to the joint axes 64 of the robot 60 according to the movement trajectory of the robot arm 63 and the like of the robot mechanism 61 stored in the operation / teaching unit 65. In this embodiment, the number of axes is 6.

[0055] Furthermore, the servo control unit 67 (first servo control unit) corresponding to each axis of the robot 60 controls the motor 68 (first motor) in the robot mechanism 61 so as to follow the position command θcom, and drives the robot arm 69 (first robot arm) via the speed reducer 53 (first speed reducer).

[0056] Specifically, the servo control unit 67 outputs a current control command IM to the motor 68 to control the drive current of the motor 68. The encoder 51 (first encoder) corresponding to the motor 68 feeds back the rotation position θM of the motor 68 to the servo control unit 67 to adjust the current control command IM.

[0057] Here, for example, Figure 3 The robot arm 69 (the first robot arm) is equivalent to Figure 2 For example, Figure 3 The reducer 53 (first reducer) is equivalent to Figure 2 The reducer 3. For example, Figure 3 The motor 68 (the first motor) is equivalent to Figure 2 Motor 2.

[0058] In addition, the robot control device 62 includes a dynamics calculation module 54 and a stop-time additional instruction calculation module 55. The dynamics calculation module 54 calculates the gravity torque τg (hereinafter, τ1g to τ6g are referred to as τg) based on θcom (hereinafter, θ1com to θ6com are referred to as θcom) as a position instruction. The gravity torque τg calculated by the dynamics calculation module 54 is output to the stop-time additional instruction calculation module 55.

[0059] Here, the gravity torque τg is the torque applied to each joint axis 64 at the stop position of the robot 69. In addition, the dynamics calculation module 54 calculates the gravity direction of each joint axis 64 at the stop position of the robot 69 based on the stop direction of the position command θcom. In addition, the "stop direction" refers to the direction in which the robot moves until it stops.

[0060] The stop-time additional command calculation module 55 calculates an additional command θp (hereinafter, θ1p to θ6p are referred to as θp) based on the gravity torque τg. The additional command θp calculated by the stop-time additional command calculation module 55 is output to the servo control unit 67 .

[0061] Here, the additional command θp is a signal input to the motor 68 in order to overshoot or undershoot the robot arm 69 in the direction opposite to the gravity direction after the stop position command θcom is input.

[0062] Figure 4 is the block diagram of the robot drive control system. Figure 4 In, only Figure 2 The drive control of one axis (Y axis) of the system shown is illustrated. Specifically, Figure 2 The first robot arm 1, the motor 2, the reducer 3, the bearing 4, the second robot arm 9, and Figure 3 The control model of the encoder 51 system shown is equivalent to Figure 4 Module 40 in (control system model of robotic mechanism 61).

[0063] like Figure 4As shown, in the module 40 , the air gap existing between the primary side 6 of the reducer and the secondary side 7 of the reducer and the spring component are set to the spring constant Ks.

[0064] In addition, in the module 40, Kt is the torque constant of the motor 2. 1 / Rg is the reciprocal of the reduction ratio Rg. 1 / (JMs+DM) is the motor transfer function. 1 / (JLs+DL) is the load transfer function. Backlash is the transfer function corresponding to the backlash representing the clearance of the reducer 3. s is the differential element. 1 / s is the integral element. Td is the external force applied to the second robot arm 9 as the load.

[0065] In addition, KPP in the position control module 20 is the proportional gain in the position loop. KP in the speed control module 30 is the speed proportional gain. KI is the speed integral gain.

[0066] In the motor transfer function, JM is the moment of inertia of the rotor 5 and the primary side 6 of the reducer around the rotation axis. DM is the viscous friction coefficient on the motor 2 side. In addition, in the load transfer function, JL is the moment of inertia of the second robot arm 9 as the load and the secondary side 7 of the reducer around the rotation axis. DL is the viscous friction coefficient on the reducer 3 side.

[0067] The position command θcom of the motor is input to the position control module 20 of the servo control unit 67. The position command θcom is converted into the gravity torque τg by the dynamics calculation module 54 and then input to the stop-time additional command calculation module 55.

[0068] The additional command calculation module 55 at stop calculates the additional command θp based on the gravity torque τg. The additional command θp is added to the original position command θcom. In addition, the motor rotation position θM is fed back to the position command θcom from the encoder 51, and the speed command ωcom of the motor 68 is generated based on this information and input to the speed control module 30.

[0069] The motor speed ωM obtained based on the motor position θM from the encoder 51 is fed back to the speed command ωcom, and the speed control module 30 generates a current control command IM (equivalent to acceleration) of the motor.

[0070] like Figure 5 As shown, a welding torch 74 is mounted on the robot arm 69 of the robot machine 61. The welding torch 74 can be moved in any direction of the X-axis direction, the Y-axis direction, and the Z-axis direction by driving the motor 68 corresponding to each joint axis 64. Here, the front end of the welding torch 74 including the protruding part of the welding wire is set as the front end of the robot arm 69.

[0071] In addition, in the following description, Figure 5In the embodiment, the posture of the front end of the robot arm 69 facing downward in the vertical direction is set to the position of 0° (6 o'clock), the posture of the front end of the robot arm 69 facing upward in the vertical direction is set to the position of 180° (12 o'clock), the posture of the front end of the robot arm 69 facing left in the horizontal direction is set to the position of 90° (9 o'clock), and the posture of the front end of the robot arm 69 facing right in the horizontal direction is set to the position of 270° (3 o'clock).

[0072] like Figure 4 As shown, the motor position YM converted from the front end position of the robot arm is represented by YM=KYM×θM. KYM is the conversion coefficient of the motor position YM converted from the rotational position θM of the motor to the front end position of the robot arm. θM is the rotational position of the motor. In addition, the values ​​shown below are set as values ​​in the Y-axis direction. In addition, any conversion coefficient changes according to the posture of the robot arm.

[0073] The robot arm tip position YA is represented by YA=KYA×θL. KYA is a conversion factor from the robot arm's rotational position θL to the robot arm tip position YA in the Y-axis direction. θL is the rotational position of the robot arm tip.

[0074] The motor speed VM converted from the robot tip speed is expressed by VM=KVM×ωM. KVM is a conversion factor for converting the motor speed VM from the motor rotation speed ωM to the robot tip speed. ωM is the motor rotation speed.

[0075] The arm tip speed VA is represented by VA=KVA×ωL. KVA is a conversion factor from the arm rotation speed ωL to the arm tip speed VA in the Y-axis direction. ωL is the motor speed at the arm tip.

[0076] <Regarding the control of the standby state of the robot arm>

[0077] Hereinafter, the relationship between the gravity torque and static friction force applied to the joint shaft 64 of the robot arm 69 when the rotation of the robot arm 69 is stopped, and the motor torque required to put the robot arm 69 in the standby state will be described.

[0078] like Figure 6 As shown, in Comparative Example 1, the robot arm 69 is rotated 90° in the direction opposite to the gravity direction (clockwise) from the position of 0° (6 o'clock) and then stopped, and the robot arm 69 is set to a standby state at the position of 90° (9 o'clock).

[0079] like Figure 7 As shown, in Comparative Example 2, the robot arm 69 is rotated 90° in the direction opposite to the gravity direction (counterclockwise) from the position of 0° (6 o'clock) and then stopped, and the robot arm 69 is set to a standby state at the position of 270° (3 o'clock).

[0080] like Figure 6 as well as Figure 7 As shown in FIG. 1 , when the rotation direction of the robot arm 69 immediately before stopping is opposite to the direction of gravity, static friction force is applied in the direction opposite to the stopping direction, that is, in the same direction as the direction of gravity. Therefore, in the standby state of the robot 60, the motor 68 needs to generate a motor torque obtained by adding the static friction torque to the gravity torque applied to the robot arm 69, and the current consumption of the motor 68 increases. In addition, in the servo control, the actual position follows the position command θcom with a delay.

[0081] like Figure 8 As shown, in Comparative Example 3, the robot arm 69 is rotated 90° in the same direction as the gravity direction (counterclockwise) from the position of 180° (12 o'clock) and then stopped, and the robot arm 69 is set to a standby state at the position of 90° (9 o'clock).

[0082] like Fig. 9 As shown, in Comparative Example 4, the robot arm 69 is rotated 90 degrees in the same direction as the gravity direction (clockwise) from the position of 180 degrees (12 o'clock) and then stopped, and the robot arm 69 is set to a standby state at the position of 270 degrees (3 o'clock).

[0083] like Figure 8 as well as Fig. 9 As shown in FIG. 1 , when the rotation direction of the robot arm 69 immediately before stopping is the same direction as the gravity direction, static friction force is applied in the direction opposite to the stopping direction, that is, in the direction opposite to the gravity direction. Therefore, in the standby state of the robot 60, only the motor torque obtained by subtracting the static friction torque from the gravity torque applied to the robot arm 69 is generated in the motor 68, and the current consumption of the motor 68 is reduced. In addition, in the servo control, the actual position follows the position command θcom with a delay.

[0084] Specifically, Fig.10 As shown, when the rotation direction of the robot arm 69 is opposite to the direction of gravity, that is, when the robot arm 69 stops after ascending, the consumption current of the motor 68 when the robot arm 69 is in the standby state is 37.2A.

[0085] On the other hand, Fig.11 As shown, when the rotation direction of the robot arm 69 is the same as the gravity direction, that is, when the robot arm 69 stops after descending, the current consumption of the motor 68 when the robot arm 69 is in the standby state is 23.6A.

[0086] In this way, when the rotation direction of the robot arm 69 immediately before stopping is the same direction as the direction of gravity, the current consumption of the motor 68 can be further reduced compared to the case of the rotation direction opposite to the direction of gravity.

[0087] Next, if Fig.12 As shown, in Comparative Example 5, the robot arm 69 is rotated 90 degrees in the direction opposite to the gravity direction (clockwise) from the position of 0 degrees (6 o'clock), for example, and then stopped, and the robot arm 69 is set to a standby state at the position of 90 degrees (9 o'clock). Then, after confirming that the robot arm 69 is in the standby state and the robot arm 69 stops at the actual position, an additional command is input to the motor 68 so that the robot arm 69 performs a small movement.

[0088] like Fig.13 As shown, in Comparative Example 6, the robot arm 69 is rotated 90 degrees in the direction opposite to the gravity direction (counterclockwise) from the position of 0 degrees (6 o'clock), for example, and then stopped, and the robot arm 69 is set to the standby state at the position of 270 degrees (3 o'clock). Then, after confirming that the robot arm 69 is in the standby state and the robot arm 69 stops at the actual position, an additional command is input to the motor 68 so that the robot arm 69 performs a small movement.

[0089] like Fig.12 as well as Fig.13 As shown, until the robot arm 69 is confirmed to be in the standby state, the motor 68 needs to generate a motor torque obtained by adding the static friction torque to the gravity torque applied to the robot arm 69, and the current consumption of the motor 68 increases. On the other hand, after the robot arm 69 is confirmed to be in the standby state and the robot arm 69 is slightly moved, the static friction force is applied in the direction opposite to the gravity direction.

[0090] Therefore, in the standby state of the robot 60 , the motor 68 only needs to generate a motor torque obtained by subtracting the static friction torque from the gravity torque applied to the robot arm 69 , and the current consumption of the motor 68 is reduced.

[0091] However, in Fig.12 as well as Fig.13 In the example shown, after the robot 60 stops and the standby state is confirmed, a step of making the robot 60 perform a minute movement is performed. Therefore, if the stop time of the robot 60 is short, there is a problem that the effect of reducing the current consumption of the motor 68 becomes small.

[0092] like Fig.14As shown, in Comparative Example 7, the robot arm 69 is rotated 90° in the same direction as the gravity direction (counterclockwise) from the position of 180° (12 o'clock) and then stopped, and the robot arm 69 is set to a standby state at the position of 90° (9 o'clock).

[0093] like Fig.15 As shown, in Comparative Example 8, the robot arm 69 is rotated 90° in the same direction as the gravity direction (clockwise) from the position of 180° (12 o'clock) and then stopped, and the robot arm 69 is set to a standby state at the position of 270° (3 o'clock).

[0094] like Fig.14 as well as Fig.15 As shown in FIG. 1 , when the rotation direction of the robot arm 69 immediately before stopping is the same direction as the gravity direction, the static friction force is applied in the direction opposite to the stopping direction, that is, in the direction opposite to the gravity direction. Therefore, in the standby state of the robot 60, only the motor torque obtained by subtracting the static friction torque from the gravity torque applied to the robot arm 69 is generated in the motor 68, and the current consumption of the motor 68 is reduced.

[0095] However, if responsiveness is emphasized in servo control, overshoot of the actual position of the robot arm 69 is likely to occur. Fig.14 as well as Fig.15 As shown by the dotted line in FIG. 8 , if the actual position overshoots the standby position even slightly, the arm 69 needs to be rotated in the direction opposite to the gravity direction in order to return the arm 69 to the standby position.

[0096] In this case, the rotation direction of the robot arm 69 immediately before stopping becomes the direction opposite to the gravity direction, and static friction force is applied in the direction opposite to the stopping direction, that is, in the same direction as the gravity direction. Therefore, in the standby state of the robot 60, the motor 68 needs to generate a motor torque obtained by adding the static friction torque to the gravity torque applied to the robot arm 69, and the current consumption of the motor 68 increases.

[0097] Therefore, in order to solve the problem in the above-mentioned comparative example, the present embodiment proposes a control method of the robot 60 that can reduce the current consumption of the motor 68 when the operation of the robot arm 69 is stopped and the robot arm 69 is in a standby state.

[0098] Specifically, Fig.16 As shown, in step S10, the stop-time additional command calculation module 55 determines whether the position command θcom is during stop. If the determination in step S10 is "yes", the process branches to step S11. If the determination in step S10 is "no", the process branches to step S16.

[0099] In step S11, the stop-time additional command operation module 55 determines whether it was in operation one cycle before the position command θcom. If the determination in step S11 is "yes", the process branches to step S12. If the determination in step S11 is "no", the process branches to step S16. In this way, the timing of stopping the input of the position command θcom to the motor 68 can be determined based on the determination results of steps S11 and S12.

[0100] In step S12, the stop-time additional instruction calculation module 55 determines whether the absolute value of the gravity torque τg calculated by the dynamics calculation module 54 is greater than a given gravity threshold value. If the determination in step S12 is "yes", the process branches to step S13. If the determination in step S12 is "no", the process branches to step S16.

[0101] Specifically, in step S12, for example, if the front end of the robot arm 69 stops near the position of 0° (6 o'clock), and the gravity torque τg added to the robot arm 69 is not so large, the current consumption of the motor 68 can be small, and it is determined that no additional instruction is required.

[0102] In step S13 , the stop-time additional command calculation module 55 determines whether the gravity torque τg is greater than 0. Here, the clockwise direction is assumed to be the positive direction for description.

[0103] like Fig.17 As shown, when the robot arm 69 is rotated clockwise from the position of 0° (6 o'clock) to the position of 90° (9 o'clock), the rotation direction of the robot arm 69 is the positive direction and is the direction opposite to the gravity direction. The sign of the gravity torque τg is negative.

[0104] like Fig.18 As shown, when the robot arm 69 is rotated counterclockwise from the position of 0° (6 o'clock) to the position of 270° (3 o'clock), the rotation direction of the robot arm 69 is negative and opposite to the direction of gravity. The sign of the gravity torque τg is positive.

[0105] like Fig.19 As shown, when the robot arm 69 is rotated counterclockwise from the position of 180° (12 o'clock) to the position of 90° (9 o'clock), the rotation direction of the robot arm 69 is negative and is the same direction as the gravity direction. The sign of the gravity torque τg is negative.

[0106] like Fig. 20As shown, when the robot arm 69 is rotated clockwise from the position of 180° (12 o'clock) to the position of 270° (3 o'clock), the rotation direction of the robot arm 69 is the positive direction and is the same direction as the gravity direction. The sign of the gravity torque τg is positive.

[0107] If the determination in step S13 is "yes", the process branches to step S14. If the determination in step S13 is "no", the process branches to step S15.

[0108] In step S14, the stop-time additional instruction calculation module 55 calculates the additional instruction θp. Fig.18 as well as Fig. 20 When the sign of the gravity torque τg is positive as in the example shown, the sign of the additional command initial value is set to a negative value as the additional command. That is, the additional command θp=-θp is set, and the process ends.

[0109] In step S15, the stop-time additional instruction calculation module 55 calculates the additional instruction θp. Fig.17 as well as Fig.19 When the sign of the gravity torque τg is negative as in the example shown, the additional command initial value is set as the additional command. That is, the additional command θp=θp is set, and the process ends.

[0110] In step S16 , it is determined whether the absolute value of the additional instruction θp is greater than 0. If the determination in step S16 is “YES”, the process branches to step S17 . If the determination in step S16 is “NO”, the process ends.

[0111] In step S17, the stop additional instruction calculation module 55 gradually decreases the absolute value of the additional instruction θp and ends the processing. In this way, after the additional instruction θp is input to the motor 68, the additional instruction θp is gradually decreased, thereby enabling the robot arm 69 to slowly rotate toward the standby position in the same direction as the gravity direction.

[0112] Specifically, in Fig.17 In the embodiment, the robot arm 69 is rotated 90° in the direction opposite to the direction of gravity (clockwise) from the position of 0° (6 o'clock) and then stopped, and the robot arm 69 is set to a standby state at the position of 90° (9 o'clock). Here, the rotation direction of the robot arm 69 immediately before the input of the stop position command θcom is the first direction (upward direction) opposite to the direction of gravity. Moreover, since the sign of the gravity torque τg is negative, an additional command θp=θp is input to overshoot the robot arm 69 in the first direction (upward direction). In addition, at the front end position of the robot arm 69, the overshoot amount at the standby position of the robot arm 69 can be less than 1 mm, so it will not be a particular problem.

[0113] exist Fig.18 In the embodiment, the robot arm 69 is stopped after rotating 90° in the direction opposite to the direction of gravity (counterclockwise) from the position of 0° (6 o'clock), and the robot arm 69 is set to a standby state at the position of 270° (3 o'clock). Here, the rotation direction of the robot arm 69 immediately before the input of the stop position command θcom is the first direction (upward direction) opposite to the direction of gravity. Moreover, since the sign of the gravity torque τg is positive, an additional command θp=-θp is input to make the robot arm 69 overshoot in the first direction (upward direction). In addition, at the front end position of the robot arm 69, the overshoot amount at the standby position of the robot arm 69 can be less than 1 mm, so it will not be a particular problem.

[0114] exist Fig.19 In the embodiment, the robot arm 69 is rotated 90° in the direction (counterclockwise) which is the same as the direction of gravity from the position of 180° (12 o'clock) and then stopped, and the robot arm 69 is set to the standby state at the position of 90° (9 o'clock). Here, the rotation direction of the robot arm 69 immediately before the input of the stop position command θcom is the second direction (downward direction) which is the same as the direction of gravity. Moreover, since the sign of the gravity torque τg is negative, an additional command θp=θp is input to prevent the robot arm 69 from overshooting in the second direction (downward direction). In addition, at the front end position of the robot arm 69, the amount of overshoot at the standby position of the robot arm 69 is less than 1 mm, so it will not be a particular problem.

[0115] exist Fig. 20 In the embodiment, the robot arm 69 is stopped after rotating 90° in the direction (clockwise) in the same direction as the direction of gravity from the position of 180° (12 o'clock), and the robot arm 69 is set to a standby state at the position of 270° (3 o'clock). Here, the rotation direction of the robot arm 69 immediately before the input of the stop position command θcom is the second direction (downward direction) in the same direction as the direction of gravity. Moreover, since the sign of the gravity torque τg is positive, an additional command θp=-θp is input to prevent the robot arm 69 from overshooting in the second direction (downward direction). In addition, at the front end position of the robot arm 69, the amount of overshoot at the standby position of the robot arm 69 is less than 1 mm, so it will not be a particular problem.

[0116] -Effects of the present embodiment-

[0117] As described above, in the control method of the robot 60 and the control device of the robot 60 involved in the present embodiment, when the robot arm 69 is set to the standby state after the movement of the robot arm 69 is stopped, in a case where the rotation direction of the robot arm 69 immediately before the stop is the first direction (upward direction) (the direction opposite to the direction of gravity), the robot arm 69 is overshot from the standby position to the first direction (upward direction), and then the robot arm 69 is rotated toward the standby position in the same direction as the direction of gravity.

[0118] In addition, when the rotation direction of the robot arm 69 immediately before stopping is the second direction (downward direction) (the same direction as the direction of gravity), the robot arm 69 is rotated toward the standby position in the same direction as the direction of gravity so as to prevent the robot arm 69 from overshooting in the second direction (downward direction) from the standby position.

[0119] Thus, regardless of whether the rotation direction of the robot arm 69 immediately before stopping is the first direction (upward direction) or the second direction (downward direction), a condition in which static friction is applied in the direction opposite to the direction of gravity can be created, similar to the case in which the robot arm 69 is stopped after being rotated in the same direction as the direction of gravity. As a result, when the robot arm 69 is set to the standby state, only a torque obtained by subtracting the static friction from the gravity applied to the robot arm 69 is generated in the motor 68, and the current consumption of the motor 68 can be reduced.

[0120] Industrial Applicability

[0121] As described above, the present disclosure can achieve a highly practical effect of reducing the current consumption of the motor when the operation of the robot arm is stopped and the robot arm is in a standby state, and is therefore extremely useful and has high industrial applicability.

[0122] Description of Reference Numerals

[0123] 54 Dynamics calculation module

[0124] 55 Add command operation module when stopping

[0125] 60 Robot

[0126] 62 Robot control device

[0127] 63 Robotic Arm

[0128] 66 Main control unit

[0129] 67 Servo Control Unit

[0130] 68 Motor

[0131] 69 Robotic arm.

Claims

1. A robot control method is a robot control method that uses a motor to move a robot arm, comprising: The step of inputting a position command to the motor to rotate the robot arm; The step of stopping the input of the position command to the motor; A step of determining whether the rotation direction of the robot arm immediately before the input of the position command is stopped is a first direction that is opposite to the direction of gravity, i.e., an upward direction, or a second direction that is the same as the direction of gravity, i.e., a downward direction; and The step of inputting additional instructions to the motor so that when it is determined to be the first direction, i.e., the upward direction, the robot arm overshoots in the first direction, i.e., the upward direction, and when it is determined to be the second direction, i.e., the downward direction, the robot arm does not overshoot in the second direction, i.e., the downward direction.

2. The robot control method according to claim 1, wherein: The control method includes the step of gradually decreasing the additional command after the additional command is input to the motor.

3. The robot control method according to claim 1, wherein: Immediately after the input of the position command is stopped, the additional command is input to the motor.

4. The robot control method according to claim 1, wherein: The additional command is input to the motor before the actual position of the robot arm reaches the standby position of the robot arm.

5. A robot control device, which is a robot control device that uses a motor to move a robot arm. The control device performs: An action of inputting a position command to the motor to rotate the robot arm; stopping the input of the position command to the motor; determining whether the rotation direction of the robot arm immediately before the input of the position command is stopped is a first direction that is opposite to the direction of gravity, i.e., an upward direction, or a second direction that is the same as the direction of gravity, i.e., a downward direction; and An additional instruction is input to the motor so that when it is determined to be the first direction, i.e., the upward direction, the robot arm overshoots in the first direction, i.e., the upward direction, and when it is determined to be the second direction, i.e., the downward direction, the robot arm does not overshoot in the second direction, i.e., the downward direction.

Citation Information

Patent Citations

  • Servo control device

    CN106774445A

  • Robot arm control method and control device

    CN1771114A

  • Control method for robot

    JP1993138562A

  • Motor load reducing method for industrial robot

    JP1997300260A

  • Robot and method for driving robot

    JP2012143850A