Robot brake detection method

By controlling feedforward torque for stationary state detection, the complex and damaged brake problems in the prior art are solved, real-time torque detection without additional sensors is achieved, cost and damage risk is reduced, and brake performance is protected.

CN118977274AActive Publication Date: 2024-11-19EFORT INTELLIGENT EQUIP CO LTD +1
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
CN202411072219.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-06
Publication Date
2024-11-19
Estimated Expiration
2044-08-06

AI Technical Summary

Technical Problem

Existing robotic brake detection methods are complex and prone to damage the brakes, increasing detection costs and potential for damage, and requiring additional torque sensors.

Method used

By controlling the feedforward torque, the motor torque information is obtained in real time, and the stationary state detection is adopted to avoid brake overload, simplify the structure and reduce costs.

Benefits of technology

Real-time torque detection without additional sensors is achieved, reducing the risk of damage, protecting brake performance and simplifying the detection process.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118977274A_ABST
    Figure CN118977274A_ABST
Patent Text Reader

Abstract

The invention relates to the field of failure analysis, in particular to a robot brake detection method which comprises the following specific steps: S0, calculating a torque adjustment step length; s1; calculating an adjustment period; (S3); closing torque feedback; (S4); moving the robot; (S5); recording T0; (S6); closing the brake; (S7); feed-forward torque is increased; s8; recording data; s9; the feed-forward torque is reduced; s10, carrying out heat treatment; recording data; (S11); performing calculation; s12, carrying out heat treatment; quitting the detection; during detection, a torque sensor does not need to be additionally installed, torque information can be obtained in real time through motor feedback, the cost is reduced, and the structure is simplified; during detection, the robot is kept in a static state, and compared with detection in the movement process, the possibility of damage is reduced; according to the method, the performance of the robot brake is detected by controlling the feedforward torque, the brake works in the detection process, the feedforward torque is continuously increased, but the brake cannot bear too large torque due to the existence of the feedback torque, and therefore the performance of the brake is effectively protected.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of failure analysis, in particular to a robot brake detection method. Background Art

[0002] If the robot is used for a long time or the motor is damaged, such as oil seal damage, the braking capacity of the motor brake will be weakened, which will not only affect the stopping distance of the robot during emergency stop, but also may cause the robot arm to fall because the braking capacity is not enough to maintain the robot's own gravity. Therefore, it is necessary to regularly test the braking capacity of each brake of the robot. When the braking capacity cannot meet the robot's deceleration and stop and maintain its own weight, the user is reminded to replace the brake in time.

[0003] In order to detect brake failure in advance, CN102150023A discloses a method for detecting robot brakes. The method requires installing a torque sensor in the robot, first making the robot move in a predetermined state, then activating the brake and turning off the motor so that the motor no longer generates torque. In this operating state, the torque sensor collects data, and the state of the brake is determined by analyzing the collected torque data. For this detection solution based on torque sensors, since torque sensors need to be installed in each joint, not only the cost is increased, but also a complex mechanical system needs to be designed, which is difficult to repair after damage.

[0004] CN107298088B discloses a brake inspection method, which first measures the load torque applied to the motor when the brake is working; then measures the load torque applied to the motor when the brake is released; finally, calculates the load torque ratio based on the load torques measured by the above two schemes, compares the calculated load torque ratio with a set threshold value, and determines the state of the brake. This detection method detects the brake during the movement of the robot, or continuously increases the driving torque after the brake is turned on until the robot moves, which will increase the wear of the brake, increase the possibility of damage and reduce its life, becoming a safety hazard.

[0005] CN105651499A relates to a brake diagnostic device, a brake diagnostic method, and a brake diagnostic system, which are used to diagnose the brake of a motor in an industrial robot, and have: a brake control unit, which operates or releases the brake; and a diagnostic unit, which diagnoses whether the brake is abnormal in the working state. According to this invention, the brake of the motor can be diagnosed.

[0006] CN107073712B discloses a method and device for evaluating static braking torque in a robot, and relates to a method, device and computer program product for evaluating static braking torque for robot joint brakes, and a robot arrangement including such a device. The braking torque evaluation device includes a torque evaluation unit, which first disables any integral control part of the robot controller, activates the brake, obtains at least one braking test position of the joint, provides a position command for commanding the joint to move to a target position to the robot controller after the brake is activated, obtains the joint position measurement after providing the position command, and uses the position command and the joint position measurement to determine whether the static braking torque of the brake meets or fails to meet the static braking torque requirement. The above two schemes need to calculate the appropriate expected position during the detection process, and the detection process is relatively cumbersome. In addition, in the process, the motor may move when the brake is in working state, which will accelerate the damage of the brake.

[0007] Most of the existing detection methods have certain limitations. Their design structures are relatively complex and may damage the brake. Therefore, it is necessary to design a simple and non-destructive brake detection method. Summary of the invention

[0008] In order to solve the above problem, the present invention proposes a robot brake detection method.

[0009] A robot brake detection method, the specific steps are as follows:

[0010] S0: Calculate the torque adjustment step: Set the torque adjustment speed during the brake detection process, set to P*Tn / s, where Tn is the rated torque of the motor, P is the proportional coefficient, set to 0.5, which means that it takes 1 / 0.5=2s to increase the torque value from zero to the rated torque, and then calculate the torque adjustment step;

[0011] S1: Calculate the torque adjustment cycle: Calculate the number of adjustment cycles N = ceil (Tb / (P*Tn)) required to increase the braking torque from zero during the brake detection process;

[0012] S3: Turn off torque feedback: Turn off the torque feedforward function before performing brake detection, and set the feedforward torque to 0, so that the feedforward torque will not affect the actual torque output of the robot;

[0013] S4: Move the robot: Move the robot to the position where the brake test is performed. This position should not affect the operation and the robot should remain stationary for 2 seconds.

[0014] S5: Record T0: Record the actual torque value T0 at this time, and check whether the current actual torque value exceeds the rated torque;

[0015] S6: Close the brake: At this time, the motor remains stationary and the current motor position Q0 is recorded;

[0016] S7: Increase feedforward torque: Increase the feedforward torque according to the given step length Ts for N cycles. After completion, the feedforward torque value will be equal to or slightly greater than the theoretical braking torque.

[0017] S8: Record position: After maintaining for 1 second, record the actual torque value T1 and the current motor position Q1 at this time;

[0018] S9: Reduce the feedforward torque: reduce the feedforward torque according to the given step length Ts for 2*N cycles. After completion, the feedforward torque value is equal to or slightly less than the opposite value of the theoretical braking torque.

[0019] S10: Record data: After 1 second, record the actual torque value T2 and the current motor position Q2. If abs(Q2-Q0)>ε, it indicates that the brake is damaged and the brake detection cannot be performed.

[0020] S11: Calculation: The actual braking torque T is calculated as follows:

[0021] T=min(T1-T0,T0-T2)

[0022] S12: Exit detection: After the calculation is completed, the feedforward torque is set to 0, the brake is opened, and the brake detection process is exited.

[0023] The step S0 is to calculate the torque adjustment step length of a single cycle as Ts=S*P*Tn according to the communication cycle S between the controller and the driver.

[0024] The Tb in step S1 is the braking torque value, and the ceil() function represents rounding up.

[0025] In step S4, the robot needs to maintain a distance of more than 200 mm from the surrounding equipment when it moves to the position for performing brake detection.

[0026] In the step S5, if abs(T0)>Tn, where the abs() function represents finding the absolute value, the detection is terminated and the user is prompted that the robot is in contact with the peripheral equipment at the current position and the brake detection cannot be performed, so please readjust the position.

[0027] In the step S8, if abs(Q1-Q0)>ε, where ε is the allowable motor position change, which can be set to 0.5 degrees, it is indicated that the brake is damaged and the brake detection cannot be performed.

[0028] The beneficial effects of the present invention are as follows: the present invention does not require the additional installation of a torque sensor during detection, and torque information can be obtained in real time through motor feedback, thereby reducing costs and simplifying structures; the present invention maintains a stationary state during detection, thereby reducing the possibility of damage compared to detection during motion; the present invention detects the performance of the robot brake by controlling the feedforward torque, and enables the brake to function during the detection process, continuously increasing the feedforward torque, but the brake will not be subjected to excessive torque due to the presence of the feedback torque, thereby effectively protecting the performance of the brake. BRIEF DESCRIPTION OF THE DRAWINGS

[0029] The present invention is further described below in conjunction with the accompanying drawings and embodiments.

[0030] Figure 1 It is the overall block diagram of the brake detection of the present invention;

[0031] Figure 2 The brake detection flow chart of the present invention;

[0032] Figure numerals: 1. brake detection module; 2. position controller; 3. feedforward torque controller; 4. brake switch controller; 5. first adder; 6. drive position controller; 7. second adder; 8. drive speed controller; 9. third adder; 10. drive torque control loop; 11. motor; 12. brake; 13. torque sensor; 14. speed sensor; 15. position sensor. DETAILED DESCRIPTION

[0033] In order to make the technical means, creative features, objectives and effects achieved by the present invention easy to understand, the present invention is further described below.

[0034] like Figure 1 to Figure 2 As shown, a robot brake detection tooling includes a brake detection module 1 that can obtain the actual position and actual torque of the motor in real time. The brake detection module 1 includes a position controller 2 for controlling the command position, a feedforward torque controller 3 for controlling the feedforward torque before and after the brake detection is performed, and a brake switch controller 4 for controlling the closing and opening of the brake 12.

[0035] The present invention does not need to install an additional torque sensor during detection, and can obtain torque information in real time through feedback from the motor 11, thereby reducing costs and simplifying the structure; the present invention keeps the robot stationary during detection, which reduces the possibility of damage compared to detection during motion; the present invention detects the performance of the robot brake by controlling the feedforward torque, and enables the brake to function during the detection process, continuously increasing the feedforward torque, but due to the existence of the feedback torque, the brake will not be subjected to excessive torque, thereby effectively protecting the performance of the brake.

[0036] The position control loop includes a position control loop, a speed control loop and a torque control loop. The position control loop includes a first adder 5 and a drive position controller 6. The speed control loop includes a second adder 7 and a drive speed controller 8. The torque control loop includes a third adder 9 and a drive torque control loop 10.

[0037] The driving torque control loop 10 is connected to the motor 11 through a wiring harness. The motor 11 is equipped with a brake 12, a torque sensor 13, a speed sensor 14 and a position sensor 15. When and where the brake 12 starts detecting is controlled by the provided brake detection instruction. The user adds the brake detection instruction at a suitable position in the program that has a certain distance from the peripheral equipment and does not affect the normal operation.

[0038] The speed can be obtained by performing differential operation on the data obtained from the position sensor 15 , thereby replacing the speed sensor 14 .

[0039] The first adder 5, the second adder 7, and the third adder 9 constitute a driver for receiving the command position sent by the position controller 2 and the actual position fed back by the position sensor 15. The command position and the actual position are superimposed by the first adder 5 and serve as the input of the driving position controller 6.

[0040] After calculation by the drive position controller 6, the command speed and the actual speed obtained from the speed sensor 14 are obtained, and the command torque is obtained through the second adder 7. The command torque and the feedforward torque output by the controller feedforward torque controller 3 and the actual torque obtained by the torque sensor 13 are calculated by the third adder 9 to obtain the combined torque input to the drive torque control loop 10. The current is calculated by the drive torque control loop 10 and input to the motor 11.

[0041] A robot brake detection method, the specific steps are as follows:

[0042] S0: Calculate the torque adjustment step: Set the torque adjustment speed during the brake detection process, set to P*Tn / s, where Tn is the rated torque of the motor, P is the proportional coefficient, set to 0.5, which means that it takes 1 / 0.5=2s to increase the torque value from zero to the rated torque, and then calculate the torque adjustment step;

[0043] S1: Calculate the torque adjustment cycle: Calculate the number of adjustment cycles N = ceil (Tb / (P*Tn)) required to increase the braking torque from zero during the brake detection process;

[0044] S3: Turn off torque feedback: Turn off the torque feedforward function before performing brake detection, and set the feedforward torque to 0, so that the feedforward torque will not affect the actual torque output of the robot;

[0045] S4: Move the robot: Move the robot to the position where the brake test is performed. This position should not affect the operation and the robot should remain stationary for 2 seconds.

[0046] S5: Record T0: Record the actual torque value T0 at this time, and check whether the current actual torque value exceeds the rated torque;

[0047] S6: Close the brake: At this time, the motor remains stationary and the current motor position Q0 is recorded;

[0048] S7: Increase feedforward torque: Increase the feedforward torque according to the given step length Ts for N cycles. After completion, the feedforward torque value will be equal to or slightly greater than the theoretical braking torque.

[0049] S8: Record data: After 1 second, record the actual torque value T1 and the current motor position Q1;

[0050] S9: Reduce the feedforward torque: reduce the feedforward torque according to the given step length Ts for 2*N cycles. After completion, the feedforward torque value is equal to or slightly less than the opposite value of the theoretical braking torque.

[0051] S10: Record data: After 1 second, record the actual torque value T2 and the current motor position Q2;

[0052] S11: Calculation: Calculate the actual braking torque T as shown below:

[0053] T=min(T1-T0,T0-T2)

[0054] S12: Exit detection: After the calculation is completed, the feedforward torque is set to 0, the brake is opened, and the brake detection process is exited.

[0055] The step S0 is to calculate the torque adjustment step length of a single cycle as Ts=S*P*Tn according to the communication cycle S between the controller and the driver.

[0056] The Tb in step S1 is the braking torque value, and the ceil() function represents rounding up.

[0057] In step S4, the robot needs to maintain a distance of more than 200 mm from the surrounding equipment when it moves to the position for performing brake detection.

[0058] In the step S5, if abs(T0)>Tn, where the abs() function represents finding the absolute value, the detection is terminated and the user is prompted that the robot is in contact with the peripheral equipment at the current position and the brake detection cannot be performed, so please readjust the position.

[0059] In the step S8, if abs(Q1-Q0)>ε, where ε is the allowable motor position change, which can be set to 0.5 degrees, it indicates that the brake is damaged and the brake detection cannot be performed. Because the driver operates in the position control mode, if the capacity of the brake 12 is lower than the theoretical value, when the feedforward torque is large, the motor 11 will move slightly, resulting in a position following error. Under the action of the feedback loop, the feedback torque will be automatically adjusted so that the sum of the feedforward torque and the feedforward torque no longer continues to increase.

[0060] In the step S10, if abs(Q2-Q0)>ε, it indicates that the brake is damaged, that is, the actual braking torque is less than the theoretical braking torque, which means that the brake 12 has reduced capacity or is damaged, and the brake detection cannot be performed.

[0061] The above shows and describes the basic principles, main features and advantages of the present invention. Those skilled in the art should understand that the present invention is not limited to the above embodiments. The above embodiments and descriptions only describe the principles of the present invention. Without departing from the spirit and scope of the present invention, the present invention may have various changes and improvements, which fall within the scope of the present invention. The scope of protection of the present invention is defined by the attached claims and their equivalents.

Claims

1. A robot brake detection method, characterized in that: The specific steps are as follows: S0: Calculate the torque adjustment step: Set the torque adjustment speed during the brake detection process, set to P*Tn / s, where Tn is the rated torque of the motor, P is the proportional coefficient, set to 0.5, which means that it takes 1 / 0.5=2s to increase the torque value from zero to the rated torque, and then calculate the torque adjustment step; S1: Calculate the adjustment cycle: Calculate the number of adjustment cycles N = ceil (Tb / (P*Tn)) required to increase the braking torque from zero during the brake detection process; S3: Turn off torque feedback: Turn off the torque feedforward function before performing brake detection, and set the feedforward torque to 0, so that the feedforward torque will not affect the actual torque output of the robot; S4: Move the robot: Move the robot to the position where the brake test is performed. This position should not affect the operation and the robot should remain stationary for 2 seconds. S5: Record T0: Record the actual torque value T0 at this time, and check whether the current actual torque value exceeds the rated torque; S6: Close the brake: At this time, the motor remains stationary and the current motor position Q0 is recorded; S7: Increase feedforward torque: Increase the feedforward torque according to the given step length Ts for N cycles. After completion, the feedforward torque value will be equal to or slightly greater than the theoretical braking torque. S8: Record data: After 1 second, record the actual torque value T1 and the current motor position Q1; S9: Reduce the feedforward torque: reduce the feedforward torque according to the given step length Ts for 2*N cycles. After completion, the feedforward torque value is equal to or slightly less than the opposite value of the theoretical braking torque. S10: Record data: After 1 second, record the actual torque value T2 and the current motor position Q2; S11: Calculation: Calculate the actual braking torque T as shown below: T=min(T1-T0,T0-T2) S12: Exit detection: After the calculation is completed, the feedforward torque is set to 0, the brake is opened, and the brake detection process is exited.

2. A robot brake detection method according to claim 1, characterized in that: The step S0 is to calculate the torque adjustment step length of a single cycle as Ts=S*P*Tn according to the communication cycle S between the controller and the driver.

3. A robot brake detection method according to claim 1, characterized in that: The Tb in step S1 is the braking torque value, and the ceil() function represents rounding up.

4. A robot brake detection method according to claim 1, characterized in that: In step S4, the robot needs to maintain a distance of more than 200 mm from the surrounding equipment when it moves to the position for performing brake detection.

5. A robot brake detection method according to claim 1, characterized in that: In the step S5, if abs(T0)>Tn, where the abs() function represents finding the absolute value, the detection is terminated and the user is prompted that the robot is in contact with the peripheral equipment at the current position and the brake detection cannot be performed, so please readjust the position.

6. A robot brake detection method according to claim 1, characterized in that: In the step S8, if abs(Q1-Q0)>ε, where ε is the allowable motor position change, which can be set to 0.5 degrees, it is indicated that the brake is damaged and the brake detection cannot be performed.

7. A robot brake detection method according to claim 1, characterized in that: In the step S10, if abs(Q2-Q0)>ε, it indicates that the brake is damaged and the brake detection cannot be performed.

Citation Information

Patent Citations

  • Method for checking a brake of a robot

    CN102150023A

  • Brake diagnosis device, brake diagnosis method and brake diagnosis system

    CN105651499A

  • Evaluation methods and devices for static braking torque in robots

    CN107073712B

  • Brake inspection device and brake inspection method

    CN107298088B

  • Method to test a brake of a robot

    US20100058850A1