Robot control methods and robot control devices

By determining the relationship between the rotation direction of the robotic arm and the direction of gravity, additional commands are input to the motor to prevent overshoot or undershoot when the robotic arm stops, thus solving the problem of high current consumption by the motor and improving motor energy efficiency.

CN119053412BActive Publication Date: 2026-11-17PANASONIC INTELLECTUAL PROPERTY MANAGEMENT CO LTD
View PDF 2 Cites 0 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

In existing technologies, the motors consume a large current when the robot is stopped, especially when the robot stops for a short time, the current reduction effect is not significant, resulting in increased power consumption and heat generation.

Method used

By determining the relationship between the rotation direction of the robotic arm and the direction of gravity, additional commands are input to the motor to cause the robotic arm to overshoot or not overshoot in the opposite or the same direction as the direction of gravity when it stops, applying static friction to balance the torque and reduce the current consumption of the motor.

Benefits of technology

This effectively reduces the current consumption of the motor in the standby state of the robotic arm, reduces power consumption and heat generation, and improves the energy efficiency of the motor.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119053412B_ABST
    Figure CN119053412B_ABST
Patent Text Reader

Abstract

The rotation direction of the robotic arm (63) immediately preceding the input of the stop position command (θcom) is determined to be either the first direction (upward direction) opposite to the direction of gravity or the second direction (downward direction) in the same direction as gravity. An additional command is input to the motor (68) such that, if the first direction (upward direction) is determined, the robotic arm (63) overshoots in the first direction (upward direction) and then gradually approaches the standby position; and if the second direction (downward direction) is determined, the robotic arm (63) does not overshoot in the second direction (downward direction) and then gradually approaches the standby position.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This disclosure relates to a robot control method and a robot control device. Background Technology

[0002] Patent Document 1 discloses a robot control method in which, if the robot remains stationary for a given period of time or longer, the axis on which the dynamic load is operating is moved slightly in the opposite direction to the load's direction of operation, and then moves back to its original position and stops.

[0003] Prior art literature

[0004] Patent documents

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

[0006] When the robot moves upward against gravity and then stops, static friction is applied in the opposite direction to the stopping direction, i.e., the direction of gravity. On the other hand, when the robot moves downward along the direction of gravity and then stops, static friction is applied in the opposite direction to gravity.

[0007] However, when the robot is stationary, the motor needs to generate torque to counteract the gravity and static friction applied to the robot. Here, the generated torque is proportional to the motor current; therefore, when the robot moves upwards and then stops, the current consumption increases.

[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 made to move slightly, forcibly creating a state in which the load is transferred from the robotic 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's stopping time is short, there is a problem that the effect of reducing the current consumption of the motor is reduced.

[0009] This disclosure was made in view of the point that its purpose is to enable a reduction in the current consumption of the motor when the robotic arm stops moving and is in a standby state.

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

[0011] In the first disclosure, it is determined whether the direction of rotation of the robotic arm immediately preceding the input of the stop position command is opposite to or the same as the direction of gravity. Furthermore, based on the determination of the robotic arm's rotation direction, an additional command is input to the motor. This reduces the current consumption of the motor when the robotic arm stops moving and is in a standby state.

[0012] Specifically, when the direction of rotation of the robotic arm immediately before it stops is the first direction (upward direction), which is opposite to the direction of gravity, static friction is applied in the direction opposite to the stopping direction, i.e., in the direction of gravity. Therefore, in the robot's standby state, the motor needs to generate torque equal to the gravity applied to the robotic arm plus the static friction, thus increasing the motor's current consumption.

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

[0014] Therefore, in this disclosure, when the robotic arm is set to standby mode after its movement has stopped, if the direction of rotation of the robotic arm immediately before it stopped is the first direction (upward direction), after the robotic arm overshoots from the standby position toward the first direction (upward direction), the robotic arm rotates toward the standby position in the same direction as gravity.

[0015] Furthermore, if the direction of rotation of the robotic arm immediately before stopping is the second direction (downward direction), after ensuring that the robotic arm does not overshoot from the standby position to the second direction (downward direction), the robotic arm is rotated toward the standby position in the same direction as gravity.

[0016] Therefore, regardless of whether the direction of rotation of the robotic arm immediately before stopping is either the first direction (upward) or the second direction (downward), a static friction force can be created in the opposite direction of gravity, just as it would be when the robotic arm is rotated in the same direction as gravity and then stopped. As a result, when the robotic arm is in standby mode, the motor only needs to generate torque equal to the torque applied to the robotic arm minus the static friction force, thus reducing the current consumption of the motor.

[0017] The second disclosure, in the robot control method disclosed in the first disclosure, includes a step of gradually decreasing the additional command after inputting the additional command to the motor.

[0018] In the second disclosure, by gradually decreasing the additional command after inputting it to the motor, the robotic arm can be slowly rotated toward the standby position in the same direction as gravity.

[0019] The third disclosure describes a robot control method disclosed in the first disclosure where, immediately after stopping the input of the position command, the additional command is input to the motor.

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

[0021] The fourth disclosure describes a robot control method disclosed in the first disclosure where the additional command is input to the motor before the actual position of the robotic arm reaches the standby position of the robotic arm.

[0022] In the fourth disclosure, since additional commands are input to the motor before the actual position of the robotic arm reaches the standby position of the robotic 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 robotic arm. The control device performs the following actions: inputting a position command to the motor to rotate the robotic arm; stopping the input of the position command to the motor; determining whether the direction of rotation of the robotic arm immediately preceding the stopping of the position command is a first direction (upward direction) opposite to the direction of gravity or a second direction (downward direction) in the same direction as the direction of gravity; and inputting an additional command to the motor such that, if the first direction (upward direction) is determined, the robotic arm overshoots in the first direction (upward direction), and if the second direction (downward direction) is determined, the robotic arm does not overshoot in the second direction (downward direction).

[0024] In the fifth disclosure, it is determined whether the direction of rotation of the robotic arm immediately preceding the input of the stop position command is opposite to or the same as the direction of gravity. Furthermore, based on the determination of the robotic arm's rotation direction, an additional command is input to the motor. This reduces the current consumption of the motor when the robotic arm stops moving and is in standby mode.

[0025] According to this disclosure, it is possible to reduce the current consumption of the motor when the robotic arm stops moving and is in standby mode. Attached Figure Description

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

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

[0028] Figure 3 It is a schematic block diagram showing the internal structure of the robot's mechanics and control devices.

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

[0030] Figure 5 This is a diagram showing the robotic arm at a 0° position.

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

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

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

[0034] Figure 9 This is a diagram illustrating the relationship between the standby position of the robotic arm and the motor torque in Comparative Example 4.

[0035] Figure 10 This is a diagram showing the current consumed by the motor when the robotic arm stops rising.

[0036] Figure 11 This is a diagram showing the current consumed by the motor when the robotic arm stops descending.

[0037] Figure 12 This is a diagram illustrating the relationship between the standby position of the robotic arm and the motor torque in Comparative Example 5.

[0038] Figure 13 This is a diagram illustrating the relationship between the standby position of the robotic arm and the motor torque in Comparative Example 6.

[0039] Figure 14 This is a diagram illustrating the relationship between the standby position of the robotic arm and the motor torque in Comparative Example 7.

[0040] Figure 15 This is a diagram illustrating the relationship between the standby position of the robotic arm and the motor torque in Comparative Example 8.

[0041] Figure 16 This is a flowchart illustrating the processing steps in the append instruction calculation module when stopping.

[0042] Figure 17 This diagram illustrates the relationship between the standby position of the robotic arm and the motor torque when an additional command is input after the robotic arm has been rotated 90° in the opposite direction to gravity.

[0043] Figure 18 This diagram illustrates the relationship between the standby position of the robotic arm and the motor torque when an additional command is input after the robotic arm has been rotated 270° in the opposite direction to gravity.

[0044] Figure 19 This diagram illustrates the relationship between the standby position of the robotic arm and the motor torque when an additional command is input after the robotic arm has been rotated 90° in the same direction as gravity.

[0045] Figure 20 This diagram illustrates the relationship between the standby position of the robotic arm and the motor torque when an additional command is input after the robotic arm has been rotated 270° in the same direction as gravity. Detailed Implementation

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

[0047] <Structure of Robots and Their Control Systems>

[0048] like Figure 1 As shown, robot 60 includes robotic mechanisms 61 and a robot control unit 62. Robotic mechanisms 61 have multiple robotic arms 63 and multiple joint axes 64. (As shown...) Figure 2 As shown, a motor 2 and a reducer 3 are located near the joint axis 64. The motor 2 and the reducer 3 are used to drive the robot mechanism 61.

[0049] like Figure 2As shown, in robot mechanism 61, the first robotic arm 1, the second robotic arm 9, the motor 2, and the reducer 3 are mechanically combined. Furthermore, in... Figure 2 In the example shown, only a partial outline of the robot mechanism 61 is illustrated to make the explanation easy to understand.

[0050] The first robotic arm 1 serves as a base for mounting the motor 2. The motor 2, reducer 3, and bearing 4 are fixed to the first robotic arm 1. A second robotic arm 9, acting as a load, is connected to the rotating part of the reducer's secondary side 7 and is driven. Alternatively, a servo motor, for example, can be used as the motor 2.

[0051] The primary side 6 of the reducer is engaged with the rotor 5 inside the motor 2, rotating relative to the rotational shaft of the motor 2 at a given motor rotational speed ωM. The reducer 3 reduces the motor rotational speed ωM to the load rotational speed ωL with a given reduction ratio Rg. The reduction ratio Rg is calculated by Rg = ωM / ωL.

[0052] Furthermore, there is a gap (clearance) and a spring component between the primary side 6 and the secondary side 7 of the reducer 3. Therefore, the above formula for the reduction ratio Rg holds 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 spring tension becomes a certain stable state.

[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 multiple robotic arms 63 acquired during teaching and the rotational movements of each motor 2 used to draw the trajectories.

[0054] The main control unit 66 receives instructions from the operation / teaching unit 65 and, based on the movement trajectory of the robotic arm 63, etc., of the robot 61 stored in the operation / teaching unit 65, outputs position commands θcom, i.e., θ1com to θ6com, for each joint axis 64 of the robot 60. Furthermore, 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 to follow the position command θcom. Moreover, the robotic arm 69 (first robotic arm) is driven via the reducer 53 (first 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. In addition, the rotational position θM of the motor 68 is fed back to the servo control unit 67 from the encoder 51 (first encoder) corresponding to the motor 68, thereby adjusting the current control command IM.

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

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

[0059] Here, the gravitational torque τg is the torque applied to each joint axis 64 when the robotic arm 69 is in the stopped position. Furthermore, the dynamics calculation module 54 calculates the gravitational direction of each joint axis 64 of the robotic arm 69 in the stopped position based on the stopping direction of the position command θcom. Additionally, the "stopping direction" refers to the direction of movement until the point of stop.

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

[0061] Here, the additional instruction θp refers to the signal input to the motor 68 after the input of the stop position instruction θcom, in order to cause the robotic arm 69 to overshoot or undershoot in the direction opposite to the direction of gravity.

[0062] Figure 4 This is a block diagram of a robot drive control system. Additionally, in Figure 4 In China, only for Figure 2 The drive control of one axis (Y-axis) of the system is illustrated. Specifically, it has... Figure 2 The components shown are: 1st robotic arm 1, 2nd motor 2, 3rd reducer 3, 4th bearing 4, 2nd robotic arm 9, and... Figure 3 The control model of the encoder 51 system shown is equivalent to Figure 4 Module 40 (control system model of robot 61) in the middle.

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

[0064] Furthermore, in module 40, Kt is the torque constant of 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 of the reducer 3. s is the differential element. 1 / s is the integral element. Td is the external force applied to the second robotic arm 9 as a load.

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

[0066] In the motor transfer function, JM is the moment of inertia about the rotational axis of the rotor 5 and the primary side 6 of the reducer combined. DM is the coefficient of viscous friction on the motor side 2. Furthermore, in the load transfer function, JL is the moment of inertia about the rotational axis of the second robotic arm 9 (as a load) and the secondary side 7 of the reducer combined. DL is the coefficient of viscous friction on the reducer side 3.

[0067] The motor position command θcom is input to the position control module 20 of the servo control unit 67. Furthermore, after the position command θcom is converted into gravitational torque τg by the dynamics calculation module 54, it is input to the stop-time append command calculation module 55.

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

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

[0070] like Figure 5 As shown, a welding torch 74 is mounted on the robotic arm 69 of the robot 61. By driving the motors 68 corresponding to each joint axis 64, the welding torch 74 can move in any direction among the X-axis, Y-axis, and Z-axis. Here, the front end of the welding torch 74, including the protruding portion of the welding wire, is defined as the front end of the robotic arm 69.

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

[0072] like Figure 4 As shown, the motor position YM converted from the position of the robotic arm's tip is represented by YM = KYM × θM. KYM is the conversion factor for converting the motor position YM from the motor's rotational position θM to the position of the robotic arm's tip. θM is the motor's rotational position. Furthermore, the values ​​shown below are also set to values ​​in the Y-axis direction. Additionally, any conversion factor varies according to the robotic arm's posture.

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

[0074] The motor speed VM, converted from the speed of the robotic arm's tip, is represented by VM = KVM × ωM. KVM is the conversion factor for converting the motor speed VM from the motor's rotational speed ωM to the speed of the robotic arm's tip. ωM is the motor's rotational speed.

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

[0076] <Control of the standby state of the robotic arm>

[0077] The following explains the relationship between the gravitational torque and static friction applied to the joint axis 64 of the robotic arm 69 when the rotation of the robotic arm 69 has stopped, and the motor torque required to put the robotic arm 69 into a standby state.

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

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

[0080] like Figure 6 as well as Figure 7 As shown, when the rotation direction of the robotic arm 69 immediately before stopping is opposite to the direction of gravity, static friction is applied in the direction opposite to the stopping direction, i.e., the same 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 gravitational torque applied to the robotic arm 69 to the static friction torque, thus increasing the current consumption of the motor 68. Furthermore, in servo control, the actual position follows the position command θcom with a delay.

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

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

[0083] like Figure 8 as well as Figure 9 As shown, when the rotation direction of the robotic arm 69 immediately before stopping is the same as the direction of gravity, static friction is applied in the opposite direction to the stopping direction, i.e., the opposite direction of gravity. Therefore, in the standby state of the robot 60, the motor 68 only needs to generate the motor torque obtained by subtracting the static friction torque from the gravitational torque applied to the robotic arm 69, thus reducing the current consumption of the motor 68. Furthermore, in servo control, the actual position follows the position command θcom with a delay.

[0084] Specifically, such as Figure 10 As shown, when the rotation direction of the robotic arm 69 is opposite to the direction of gravity, that is, when the robotic arm 69 stops after rising, the current consumption of the motor 68 when the robotic arm 69 is in standby mode is 37.2A.

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

[0086] Thus, compared to the case where the direction of rotation of the robotic arm 69 is the same as the direction of gravity, which is right before it stops, the current consumption of the motor 68 can be reduced.

[0087] Next, as Figure 12 As shown, in Comparative Example 5, the robotic arm 69 is rotated 90° from, for example, the position at 0° (6 o'clock) in the opposite direction to gravity (clockwise) and then stopped. The robotic arm 69 is then set to a standby state at the 90° (9 o'clock) position. Then, after confirming that the robotic arm 69 is in standby mode and has stopped at its actual position, an additional command is input to the motor 68 to cause the robotic arm 69 to perform a minor movement.

[0088] like Figure 13 As shown, in Comparative Example 6, the robotic arm 69 is rotated 90° from, for example, the position at 0° (6 o'clock) in the opposite direction to gravity (counterclockwise) and then stopped. The robotic arm 69 is then set to a standby state at the position at 270° (3 o'clock). After confirming that the robotic arm 69 is in standby mode and has stopped at its actual position, an additional command is input to the motor 68 to cause the robotic arm 69 to perform a minor movement.

[0089] like Figure 12 as well as Figure 13 As shown, during the period until it is confirmed that the robotic arm 69 is in a standby state, the motor 68 needs to generate a motor torque that is the sum of the gravitational torque applied to the robotic arm 69 and the static friction torque, which increases the current consumption of the motor 68. On the other hand, after it is confirmed that the robotic arm 69 is in a standby state and the robotic arm 69 has made a small movement, a static friction force is applied in the opposite direction to the direction of gravity.

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

[0091] However, in Figure 12 as well as Figure 13 In the example shown, after the robot 60 stops moving and is confirmed to be in standby mode, the step of making the robot 60 perform a small movement is performed. Therefore, when the stopping time of the robot 60 is short, there is a problem that the effect of reducing the current consumption of the motor 68 is reduced.

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

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

[0094] like Figure 14 as well as Figure 15 As shown, when the direction of rotation of the robotic arm 69 immediately before it stops is the same as the direction of gravity, static friction is applied in the opposite direction to the stopping direction, i.e., the opposite direction of gravity. Therefore, in the standby state of the robot 60, the motor 68 only needs to generate the motor torque obtained by subtracting the static friction torque from the gravitational torque applied to the robotic arm 69, thus reducing the current consumption of the motor 68.

[0095] However, if responsiveness is prioritized in servo control, overshoot of the actual position of the robotic arm 69 can easily occur. Furthermore, if in Figure 14 as well as Figure 15 As shown by the dashed line, if the actual position is even slightly overshoot of the standby position, the robotic arm 69 needs to be rotated in the opposite direction of gravity in order to return it to the standby position.

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

[0097] Therefore, in order to solve the problems in the comparative example described above, a control method for the robot 60 that can reduce the current consumption of the motor 68 when the robot arm 69 is stopped and put into a standby state is proposed.

[0098] Specifically, such as Figure 16 As shown, in step S10, the stop-time append instruction calculation module 55 determines whether the position instruction θcom is in a stopped state. 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 append instruction calculation module 55 determines whether the device is in operation one cycle before the position instruction θ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 for stopping the input of the position instruction θcom for the motor 68 can be determined based on the determination results of steps S11 and S12.

[0100] In step S12, the stop-time appending instruction calculation module 55 determines whether the absolute value of the gravitational torque τg calculated by the dynamics calculation module 54 is greater than a given gravity threshold. 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 robotic arm 69 stops near the position of 0° (6 o'clock), and the gravitational torque τg attached to the robotic arm 69 is not so large, the current consumption of the motor 68 can be small, and therefore it is determined that no additional command needs to be given.

[0102] In step S13, the stop-time appending instruction calculation module 55 determines whether the gravitational torque τg is greater than 0. Here, the clockwise direction is defined as the positive direction for explanation.

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

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

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

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

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

[0108] In step S14, the stop-time append instruction processing module 55 processes the append instruction θp. Specifically, in... Figure 18 as well as Figure 20 In the example shown, if the sign of the gravitational torque τg is positive, the value that sets the initial value of the append command to negative is used as the append command. That is, the append command is set to θp = -θp, and the processing ends.

[0109] In step S15, the stop-time append instruction processing module 55 processes the append instruction θp. Specifically, in... Figure 17 as well as Figure 19 In the example shown, where the gravitational torque τg is negative, the initial value of the append command is used as the append command. That is, the append command is set to θp = θp, and the processing ends.

[0110] In step S16, it is determined whether the absolute value of the append 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-time append instruction calculation module 55 gradually decreases the absolute value of the append instruction θp and ends the processing. Thus, after the append instruction θp is input to the motor 68, the append instruction θp is gradually decreased, thereby enabling the robotic arm 69 to slowly rotate toward the standby position in the same direction as gravity.

[0112] Specifically, in Figure 17 In this process, the robotic arm 69 is rotated 90° from, for example, the position at 0° (6 o'clock) in the opposite direction to gravity (clockwise) and then stopped. At the 90° (9 o'clock) position, the robotic arm 69 is set to a standby state. Here, the rotation direction of the robotic arm 69 immediately preceding the input of the stop position command θcom is the first direction (upward direction) opposite to the direction of gravity. Furthermore, since the gravitational torque τg is negative, the additional command θp = θp is input to cause the robotic arm 69 to overshoot in the first direction (upward direction). Additionally, at the tip position of the robotic arm 69, the overshoot at the standby position only needs to be less than 1mm, and therefore will not be a significant problem.

[0113] exist Figure 18 In this process, the robotic arm 69 is rotated 90° from, for example, the position at 0° (6 o'clock) in the opposite direction to gravity (counterclockwise) and then stopped, and is set to standby mode at the position at 270° (3 o'clock). Here, the rotation direction of the robotic 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 gravitational torque τg is positive, the additional command θp = -θp is input to cause the robotic arm 69 to overshoot in the first direction (upward direction). In addition, at the tip position of the robotic arm 69, the overshoot at the standby position is less than 1mm, so it will not be a particular problem.

[0114] exist Figure 19 In this process, the robotic arm 69 is rotated 90° from, for example, a position of 180° (12 o'clock) in the same direction as gravity (counterclockwise) and then stopped. At the 90° (9 o'clock) position, the robotic arm 69 is set to a standby state. Here, the direction of rotation of the robotic arm 69 immediately preceding the input of the stop position command θcom is the second direction (downward direction) in the same direction as gravity. Furthermore, since the gravitational torque τg is negative, the additional command θp = θp is input to prevent the robotic arm 69 from overshooting in the second direction (downward direction). Additionally, at the tip position of the robotic arm 69, the amount of overshoot at the standby position is less than 1 mm, and therefore will not be a significant problem.

[0115] exist Figure 20 In this process, the robotic arm 69 is rotated 90° from, for example, a position of 180° (12 o'clock) in the same direction as gravity (clockwise) and then stopped. The robotic arm 69 is then set to a standby state at a position of 270° (3 o'clock). Here, the direction of rotation of the robotic arm 69 immediately preceding the input of the stop position command θcom is the second direction (downward direction) in the same direction as gravity. Furthermore, since the sign of the gravitational torque τg is positive, the additional command θp = -θp is input to prevent the robotic arm 69 from overshooting in the second direction (downward direction). Additionally, at the tip position of the robotic arm 69, the amount of overshoot at the standby position is less than 1 mm, and therefore will not be a significant problem.

[0116] -Effects of this implementation method-

[0117] As described above, in the control method and control device of the robot 60 according to this embodiment, when the robot arm 69 is set to standby state after the movement of the robot arm 69 is stopped, if the rotation direction of the robot arm 69 immediately before stopping is the first direction (upward direction) (opposite to the direction of gravity), the robot arm 69 is overshot from the standby position in 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] Furthermore, when the direction of rotation of the robotic arm 69 immediately before stopping is the second direction (downward direction) (the same direction as the direction of gravity), after preventing the robotic arm 69 from overshooting from the standby position in the second direction (downward direction), the robotic arm 69 is rotated toward the standby position in the same direction as the direction of gravity.

[0119] Therefore, regardless of whether the rotation direction of the robotic arm 69 immediately before stopping is either the first direction (upward) or the second direction (downward), a static friction force can be created in the opposite direction of gravity, just as it would be when the robotic arm 69 is rotated in the same direction as gravity and then stopped. As a result, when the robotic arm 69 is in standby mode, the motor 68 only needs to generate the torque obtained by subtracting the static friction force from the gravity applied to the robotic arm 69, thus reducing the current consumption of the motor 68.

[0120] Industrial availability

[0121] As explained above, this disclosure provides a highly practical effect by reducing the current consumption of the motor when the robotic arm stops moving and is in standby mode, making it extremely useful and highly industrially applicable.

[0122] Explanation of reference numerals in the attached figures

[0123] 54. Dynamics Calculation Module

[0124] 55. Append Instruction Calculation Module at Stop

[0125] 60 robots

[0126] 62 Robot control device

[0127] 63 robotic arms

[0128] 66 Main Control Unit

[0129] 67 Servo Control Unit

[0130] 68 motors

[0131] 69. Robotic arm.

Claims

1. A robot control method, which uses a motor to move a robotic arm, comprising: The step of inputting position commands to the motor to rotate the robotic arm; The step of stopping the input of the position command for the motor; The step of determining whether the direction of rotation of the robotic arm immediately before the input of the stop position command is the first direction, i.e., the upward direction, which is opposite to the direction of gravity, or the second direction, i.e., the downward direction, which is the same as the direction of gravity; and An additional command is input to the motor such that, if the direction is determined to be the first direction (upward), after the robotic arm overshoots from the standby position to the first direction (upward), the robotic arm rotates towards the standby position in the same direction as gravity; and if the direction is determined to be the second direction (downward), after the robotic arm does not overshoot from the standby position to the second direction (downward), the robotic arm rotates towards the standby position in the same direction as gravity.

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

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

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

5. A robot control device that uses a motor to move a robotic arm. The control device performs: The action of inputting position commands to the motor to make the robotic arm rotate; Stop the input of the position command for the motor; Determine whether the direction of rotation of the robotic arm immediately preceding the input of the stop position command is the first direction, i.e., the upward direction, which is opposite to the direction of gravity, or the second direction, i.e., the downward direction, which is the same as the direction of gravity. and An additional command is input to the motor so that, if the direction is determined to be the first direction (upward), after the robotic arm overshoots from the standby position to the first direction (upward), the robotic arm rotates towards the standby position in the same direction as gravity; and if the direction is determined to be the second direction (downward), after the robotic arm does not overshoot from the standby position to the second direction (downward), the robotic arm rotates towards the standby position in the same direction as gravity.

Citation Information

Patent Citations

  • Actuator driving method

    US5378972A

  • Position control method and position control device

    WO2011004587A1