Load mass identification method and device of robot, medium, controller and product

By acquiring and comparing the relationship between load mass and current of SCARA robots, identifying and correcting the initial mass, the operation abnormality caused by load mass setting errors is solved, ensuring the stability and safety of the robot's operation.

CN119036443AActive Publication Date: 2024-11-29GREE ELECTRIC APPLIANCE INC OF ZHUHAI
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
CN202411143093.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-20
Publication Date
2024-11-29
Estimated Expiration
2044-08-20

AI Technical Summary

Technical Problem

When the load quality setting of SCARA robot is incorrect, it will cause control loop oscillation, motor abnormal noise and structural damage, and may even cause safety accidents.

Method used

By obtaining the correspondence or functional relationship between the load mass and current of the SCARA robot, identify the initial mass, and compare it with the gravity load command, issue prompt information or correct the load mass to ensure that the command is set reasonably.

Benefits of technology

It effectively prevents abnormal operation caused by excessive gap between servo parameters and actual working conditions, ensures stable operation of the robot, and avoids structural damage and safety accidents.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119036443A_ABST
    Figure CN119036443A_ABST
Patent Text Reader

Abstract

The invention provides a load mass identification method and device of an SCARA robot, a medium, a controller and a product. The method comprises the steps that the corresponding relation, obtained through pre-testing, of the load mass of the SCARA robot and current or the function relation, obtained through pre-fitting, of the load mass of the SCARA robot and the current is obtained; and when the SCARA robot is in a position mode, and when the enabling flag bit is effective and the position instruction is 0, the initial mass of the load of the SCARA robot is identified according to the corresponding relation between the load mass and the current or the function relation between the load mass and the current. When the SCARA robot is in a position mode, when the enabling flag bit is valid and the position instruction is not 0, comparing the initial mass with the mass set by the gravity load instruction, and determining whether the setting of the gravity load instruction is reasonable; if not, prompt information is sent out. According to the scheme, abnormal operation caused by too large differences between servo parameters and operation control parameters of the robot and actual working conditions can be prevented.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of control, and in particular to a method, device, medium, controller and product for identifying the load mass of a robot. Specifically, it relates to a method, device, computer-readable storage medium, robot controller and computer program product for identifying the load mass of a SCARA robot. Background Art

[0002] During use, SCARA robots often need to install load fixtures at the ends of the three axes to work. When the fixture is used and the load is added, the load inertia of the robot changes. At this time, it is generally necessary to fill in the mass, center of mass and other parameters of the load through gravity load instructions to calculate the true inertia of each axis, so as to ensure the normal operation of the robot, and avoid low-frequency jitter or loop oscillation caused by excessive inertia deviation, acceleration and speed that do not meet their own operating conditions, and other problems.

[0003] When the user fills in incorrect gravity load instruction parameters, for example, filling in the instructions corresponding to a fully loaded gravity load under the condition of an empty robot, the center of mass and mass deviations are too large. At this time, the robot controller will also cause control loop oscillation due to incorrectly calculated inertia, and the robot's motor will produce abnormal noises; secondly, the wrong parameters will also affect the robot's operating speed, acceleration and other parameters, causing the robot's operating conditions to be inconsistent with the actual conditions, causing destructive effects on the structure, and even causing serious safety accidents. Summary of the invention

[0004] The main purpose of the present invention is to overcome the defects of the above-mentioned related technologies and provide a robot load mass identification method, device, medium, controller and product to solve the problem in the related technology that the gravity load instruction setting error of the SCARA robot will cause abnormal operation.

[0005] The present invention provides a method for identifying the load mass of a SCARA robot, comprising:

[0006] Obtain the correspondence between the load mass and the current of the SCARA robot obtained by pre-test or the functional relationship between the load mass and the current of the SCARA robot obtained by pre-fitting; the current is the third axis current of the robot; when the SCARA robot is in position mode, when the enable flag is valid and the position instruction is 0, the initial mass of the load of the SCARA robot is identified according to the correspondence between the load mass and the current or the functional relationship between the load mass and the current; when the SCARA robot is in position mode, when the enable flag is valid and the position instruction is not 0, the identified initial mass is compared with the mass set by the gravity load instruction to determine whether the setting of the gravity load instruction is reasonable; if it is determined that the setting of the gravity load instruction is unreasonable, a corresponding prompt message is issued.

[0007] Optionally, the functional relationship between the load mass and the current is obtained by performing function fitting based on the corresponding relationship between the load mass and the current of the SCARA robot obtained in the pre-test, and the functional relationship between the load mass and the current is expressed as:

[0008]

[0009] Among them, F is the load mass, Iq is the quadrature-axis current, Kt is the torque coefficient, and a is the conversion coefficient between the load mass and the current; according to the corresponding relationship between the load mass and the current, the conversion coefficient between the load mass and the current in the functional relationship is obtained.

[0010] Optionally, the identified initial mass is compared with the mass set by the gravity load instruction to determine whether the setting of the gravity load instruction is reasonable, including: judging whether the absolute value of the difference between the initial mass and the mass set by the gravity load instruction is less than a first preset difference; if the absolute value of the difference is judged to be less than the first preset difference, then determining that the mass setting of the gravity load instruction is reasonable; if the absolute value of the difference is judged to be not less than the first preset difference, then determining that the mass setting of the gravity load instruction is unreasonable.

[0011] Optionally, according to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current, the initial mass of the load of the SCARA robot is identified, including: sampling the current of the SCARA robot every n execution cycles to obtain m sampled currents, and calculating an average value of the m sampled currents, recorded as a first current average value; according to the first current average value, using the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current, the initial mass of the load of the SCARA robot is calculated.

[0012] Optionally, it also includes: obtaining the correspondence between the pre-configured load mass of the SCARA robot and the current difference caused by the friction force of the up and down movement of the SCARA robot and its own gravity; determining the current difference caused by the friction force of the up and down movement of the SCARA robot and its own gravity when the robot is unloaded according to the correspondence and the first current average value, recorded as the first current difference; sampling the current of the SCARA robot every n execution cycles to obtain m sampled currents, and calculating the average value of the m sampled currents, recorded as the second current average value; judging whether the absolute value of the difference between the first current average value and the second current average value is greater than the absolute value of the first current difference; if it is judged that the absolute value of the difference between the first current average value and the second current average value is greater than the absolute value of the first current difference, correcting the load mass of the SCARA robot.

[0013] Optionally, the load mass of the SCARA robot is corrected, including: according to the second current average value, utilizing the correspondence between the load mass and the current or the relationship function between the load mass and the current, identifying the mass of the load of the robot, recorded as the first mass; the corrected load mass of the robot is equal to the average of the initial mass and the first mass.

[0014] Optionally, after correcting the load mass of the SCARA robot, it is determined whether the absolute value of the difference between the corrected load mass and the mass set by the gravity load instruction is less than a second preset difference; if it is determined that the absolute value of the difference is less than the second preset difference, load mass identification will no longer be performed in the enabled state of the SCARA robot until the motor enable of the SCARA robot is 0.

[0015] On the other hand, the present invention provides a load mass identification device for a SCARA robot, comprising: a first acquisition unit, used to obtain the corresponding relationship between the load mass and current of the SCARA robot obtained by pre-test or the functional relationship between the load mass and current of the SCARA robot obtained by pre-fitting; the current is the third axis current of the robot; a first identification unit, used to identify the initial mass of the load of the SCARA robot according to the corresponding relationship between the load mass and current or the functional relationship between the load mass and current when the SCARA robot is in position mode, when the enable flag is valid and the position instruction is 0; a first determination unit, used to compare the identified initial mass with the mass set by the gravity load instruction when the SCARA robot is in position mode, when the enable flag is valid and the position instruction is not 0, to determine whether the setting of the gravity load instruction is reasonable; a prompt unit, used to issue a corresponding prompt message if the determination unit determines that the setting of the gravity load instruction is unreasonable.

[0016] Optionally, the functional relationship between the load mass and the current is obtained by performing function fitting based on the corresponding relationship between the load mass and the current of the SCARA robot obtained in the pre-test, and the functional relationship between the load mass and the current is expressed as:

[0017]

[0018] Where, F is the load mass, Iq is the quadrature axis current, Kt is the torque coefficient, and a is the conversion coefficient between load mass and current;

[0019] According to the corresponding relationship between the load mass and the current, a conversion coefficient between the load mass and the current in the functional relationship is obtained.

[0020] Optionally, the first determination unit compares the identified initial mass with the mass set by the gravity load instruction to determine whether the setting of the gravity load instruction is reasonable, including: judging whether the absolute value of the difference between the initial mass and the mass set by the gravity load instruction is less than a first preset difference; if the absolute value of the difference is judged to be less than the first preset difference, then determining that the mass setting of the gravity load instruction is reasonable; if the absolute value of the difference is judged to be not less than the first preset difference, then determining that the mass setting of the gravity load instruction is unreasonable.

[0021] Optionally, the first identification unit identifies the initial mass of the load of the SCARA robot according to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current, including: sampling the current of the SCARA robot every n execution cycles to obtain m sampled currents, and calculating an average value of the m sampled currents, recorded as a first current average value; according to the first current average value, using the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current, calculating the initial mass of the load of the SCARA robot.

[0022] Optionally, it also includes: a second acquisition unit, which is used to obtain the correspondence between the pre-configured load mass of the SCARA robot and the current difference caused by the friction force of the up and down movement of the SCARA robot and its own gravity; a second determination unit, which is used to determine the current difference caused by the friction force of the up and down movement of the SCARA robot and its own gravity when it is unloaded according to the correspondence and the first current average value, recorded as the first current difference; a calculation unit, which is used to sample the current of the SCARA robot every n execution cycles, obtain the current sampled m times, and calculate the average value of the current sampled m times, recorded as the second current average value; a first judgment unit, which is used to judge whether the absolute value of the difference between the first current average value and the second current average value is greater than the absolute value of the first current difference; a correction unit, which is used to correct the load mass of the SCARA robot if it is judged that the absolute value of the difference between the first current average value and the second current average value is greater than the absolute value of the first current difference.

[0023] Optionally, the correction unit corrects the load mass of the SCARA robot, including: according to the second current average value, using the corresponding relationship between the load mass and the current or the relationship function between the load mass and the current, identifying the mass of the load of the robot, recorded as the first mass; the corrected load mass of the robot is equal to the average of the initial mass and the first mass.

[0024] Optionally, it also includes: a second judgment unit, which is used to judge whether the absolute value of the difference between the corrected load mass and the mass set by the gravity load instruction is less than a second preset difference after the load mass of the SCARA robot is corrected; if it is judged that the absolute value of the difference is less than the second preset difference, the load mass identification will no longer be continued in the enabled state of the SCARA robot until the motor enable of the SCARA robot is 0.

[0025] Another aspect of the present invention provides a computer-readable storage medium having a computer program stored thereon, wherein the program implements the steps of any of the aforementioned methods when executed by a processor.

[0026] In another aspect, the present invention provides a robot controller, comprising a processor, a memory, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of any of the aforementioned methods when executing the program.

[0027] In another aspect, the present invention provides a robot controller, comprising any of the aforementioned load mass identification devices for SCARA robots.

[0028] In yet another aspect, the present invention provides a computer program product, comprising a computer program, wherein when the computer program is executed by a processor, the steps of any of the aforementioned methods are implemented.

[0029] According to the technical solution of the present invention, by collecting the motor currents of the three axes of the SCARA robot and performing initial quality identification on the quality through the correspondence or functional relationship between the current and the quality, when an error occurs in the setting of the gravity load instruction of the SCARA robot, a comparison can be made between the identified load quality and the quality set by the instruction to prevent abnormal operation caused by a large gap between the robot's servo parameters and operation control parameters and the actual working conditions.

[0030] According to the technical solution of the present invention, based on the different sizes of currents generated when the three axes move up and down, the mass changes during operation are identified, and the initial value of the load mass is continuously corrected to obtain the final mass. The algorithm is simple to implement, does not need to establish a dynamic model, and has strong universality. BRIEF DESCRIPTION OF THE DRAWINGS

[0031] The drawings described herein are used to provide a further understanding of the present invention and constitute a part of the present invention. The exemplary embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute an improper limitation of the present invention. In the drawings:

[0032] Figure 1 1 is a schematic diagram of a method for identifying the load mass of a SCARA robot according to an embodiment of the present invention;

[0033] Figure 2 The relationship curve between different load masses and conversion coefficients is shown;

[0034] Figure 3 A flowchart of a specific implementation of the step of identifying the initial mass of the load of the SCARA robot according to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current is shown;

[0035] Figure 4A corresponding relationship curve between load mass and current according to the present invention is shown;

[0036] Figure 5 is a method schematic diagram of another embodiment of the load mass identification method of the SCARA robot provided by the present invention;

[0037] Figure 6 The corresponding relationship curve between the load mass of the SCARA robot and the current difference caused by the friction force of the third axis of the SCARA robot running up and down and its own gravity is shown;

[0038] Figure 7 It is a method flow chart of a specific embodiment of the load mass identification method of the SCARA robot provided by the present invention;

[0039] Figure 8 It is a structural block diagram of an embodiment of a load mass identification device for a SCARA robot provided by the present invention;

[0040] Fig. 9 It is a structural block diagram of another embodiment of the load mass identification device of the SCARA robot provided by the present invention. DETAILED DESCRIPTION

[0041] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be clearly and completely described below in conjunction with the specific embodiments of the present invention and the corresponding drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.

[0042] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

[0043] The invention provides a load mass identification method for a SCARA robot.

[0044] Figure 1It is a method schematic diagram of an embodiment of the load mass identification method of the SCARA robot provided by the present invention.

[0045] like Figure 1 As shown, according to one embodiment of the present invention, the load quality identification method at least includes step S110, step S120, step S130 and step S140.

[0046] Step S110, obtaining a corresponding relationship between the load mass and the current of the SCARA robot obtained by pre-testing or a functional relationship between the load mass and the current of the SCARA robot obtained by pre-fitting.

[0047] Specifically, the current is the third axis current of the SCARA robot. Under conditions of different load masses, the magnitude of the third axis current of the robot is collected to obtain a corresponding relationship between the load mass and the current magnitude. The current can specifically be a quadrature axis current. The corresponding relationship can be drawn into a relationship table between the load mass and the current or fitted into a relationship curve between the load mass and the current.

[0048] The functional relationship between the load mass and the current is obtained by performing function fitting based on the corresponding relationship between the load mass and the current of the SCARA robot obtained in the pre-test.

[0049] In a specific implementation, the functional relationship between load mass and current is expressed as:

[0050]

[0051] Torque = force * lever arm, torque = cross-axis current Iq * torque coefficient Kt, so the conversion coefficient a can be understood as the size of the lever arm, a is approximately equal to the lever arm but not equal to the lever arm, so theoretically a is a constant and can be regarded as a coefficient.

[0052] Among them, F is the load mass (unit: kg), Iq is the collected quadrature axis current, Kt is the torque coefficient (taking a 6kg SCARA robot as an example, three-axis Kt = 0.331N m / Arms), and a is the conversion coefficient between load mass and current. The conversion coefficient between load mass and current can be obtained as follows:

[0053]

[0054] Therefore, the conversion coefficient of the load mass and the current in the functional relationship can be obtained according to the corresponding relationship between the load mass and the current. For example, the conversion coefficient a of the load mass and the current can be calculated according to the corresponding relationship table of the load mass and the current of the SCARA robot obtained in advance.

[0055] Since the smaller the load mass, the greater the influence of friction, the lower the load mass, the less accurate the conversion coefficient a will be. Figure 2 The figure shows the relationship between different load masses and conversion coefficients. The horizontal axis represents the load mass, and the vertical axis represents the conversion coefficient between the load mass and the current. Figure 2 It can be seen that the conversion coefficient a tends to be more stable as the load mass increases, so the conversion coefficient a is averaged:

[0056]

[0057] Where i is the load mass, I q(i) is the cross-axis current when the load mass is i, k is the maximum load mass, j is the starting load mass, and starting from j, the cross-axis current I is collected once for each increase of 1kg load q(i) , until i = k. Therefore, the numerator is the sum of the conversion coefficient a with j as the starting load mass and k as the ending load mass, and the denominator is k-j+1. For example, for a 6kg SCARA robot, in order to reduce the impact of friction, j = 3, k = 6 can be taken, and a = 0.03448 is obtained.

[0058] The functional relationship between load mass and current can be obtained as follows:

[0059]

[0060] According to the above formula, the load mass can be calculated by collecting the quadrature-axis current of the robot's motor. The more accurate the table is and the finer the load level division is, the more accurate the conversion coefficient a will be, and the more accurate the identification will be.

[0061] Step S120, when the SCARA robot is in position mode, when the enable flag is valid and the position instruction is 0, the initial mass of the load of the SCARA robot is identified according to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current.

[0062] Specifically, when the robot is in the position mode (ie, the control mode in which the input command is the position command), when the enable flag is valid and the position command is 0, the initial mass m0 of the robot load is identified and calculated.

[0063] Figure 3 A flowchart of a specific implementation of the step of identifying the initial mass of the load of the SCARA robot according to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current is shown. Figure 3 As shown, in a specific implementation, step S120 includes steps S121 and S122.

[0064] Step S121, sampling the current of the SCARA robot once every n execution cycles to obtain m sampled currents, and calculating an average value of the m sampled currents, which is recorded as a first current average value.

[0065] Specifically, the current may be a quadrature axis current. The current is sampled, and current data is sampled once every n execution cycles, and the current data is collected m times, and then the m current values ​​are accumulated, and the average value of the accumulated currents collected m times every n cycles is calculated, and recorded as the first current average value, so that the error caused by more noise on the current can be reduced, and the current average value is obtained, that is:

[0066]

[0067] in, is the average value of the current sampled m times, that is, the first current average value; T is the execution cycle; Trq i is the current collected every n execution cycles, which is the instantaneous value of the current.

[0068] Step S122: According to the first current average value, using the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current, the initial mass of the SACRA robot load is calculated.

[0069] After obtaining the first current average value, the initial mass of the SACRA robot load corresponding to the first current average value is found by using the corresponding relationship between the load mass and the current, or the initial mass of the SACRA robot load is calculated based on the first current average value and the functional relationship between the load mass and the current. For example, Figure 4 An example of the corresponding relationship between the load mass and the current according to the present invention is shown. The horizontal axis represents the load mass, and the vertical axis represents the current magnitude. Figure 4 The corresponding relationship between the load mass and the current is shown, and the corresponding initial mass m0 is found, or the initial mass m0 is calculated according to the functional relationship between the load mass and the current.

[0070] Step S130, when the SCARA robot is in position mode, when the enable flag is valid and the position instruction is not 0, the identified initial mass is compared with the mass set by the gravity load instruction to determine whether the setting of the gravity load instruction is reasonable.

[0071] Specifically, when the robot is in position mode, when the enable flag is valid and the position instruction is not 0, the robot is considered to have started running. At this time, the identified initial mass is compared with the mass set by the gravity load instruction to determine whether the setting of the gravity load instruction is reasonable.

[0072] In a specific embodiment, it is determined whether the absolute value of the difference between the initial mass and the mass set by the gravity load instruction is less than a first preset difference; if it is determined that the absolute value of the difference is less than the first preset difference, it is determined that the mass setting of the gravity load instruction is reasonable; if it is determined that the absolute value of the difference is not less than the first preset difference, it is determined that the mass setting of the gravity load instruction is unreasonable.

[0073] The gravity load instruction is an instruction set by the user according to the load at the load end. The instruction includes the load mass and may also include the eccentricity and load inertia. Specifically, m0 is compared with the mass m2 set by the gravity load instruction. If the difference between the two is within the range of the first preset difference Δm (the allowable difference range between the actual mass and the mass set by the gravity load instruction), that is, |m0-m2|<Δm, the load mass setting is considered reasonable and the gravity load parameters are effective. If the difference between the two is outside the range of the first preset difference Δm, the load mass setting is considered unreasonable.

[0074] Step S140: If it is determined that the setting of the gravity load instruction is unreasonable, a corresponding prompt message is issued.

[0075] Specifically, if the setting of the gravity load instruction is unreasonable, a corresponding prompt message is issued to remind the user that the set mass does not match the actual mass.

[0076] Figure 5 It is a method schematic diagram of another embodiment of the load mass identification method of the SCARA robot provided by the present invention.

[0077] like Figure 5 As shown, according to another embodiment of the present invention, the load quality identification method further includes step S150, step S160, step S170, step S180 and step S190.

[0078] Step S150, obtaining a correspondence between a pre-configured load mass of the SCARA robot and a current difference caused by the friction force of the SCARA robot moving up and down and its own gravity.

[0079] Step S160, determining the current difference fErr caused by the friction force of the robot running up and down and its own gravity when the robot is unloaded according to the corresponding relationship and the first current average value, and recording it as the first current difference.

[0080] Specifically, the corresponding relationship between the load mass of the SCARA robot and the current difference caused by the friction force of the third axis of the SCARA robot running up and down and its own gravity is obtained in advance through testing. Figure 6The corresponding relationship curve between the load mass of the SCARA robot and the current difference caused by the friction force of the third axis of the SCARA robot running up and down and its own gravity is shown, that is, the different current differences caused by the friction force of the third axis of the SCARA robot running up and down with different load masses and its own gravity. The horizontal axis represents the load mass, and the vertical axis represents the current difference. According to the above corresponding relationship curve and the first current average value, the current difference caused by the friction force of the SCARA robot running up and down when unloaded and its own gravity, that is, the first current difference, can be obtained.

[0081] Step S170, sampling the current of the robot every n execution cycles to obtain m sampled currents, and calculating an average value of the m sampled currents, which is recorded as a second current average value.

[0082] Step S180, determining whether the absolute value of the difference between the first current average value and the second current average value |IqErr| is greater than the absolute value of the first current difference |fErr|.

[0083] Step S190: If it is determined that the absolute value of the difference between the first current average value and the second current average value is greater than the absolute value of the first current difference, the load mass of the SCARA robot is corrected.

[0084] Specifically, the same method as that used in the aforementioned initial mass identification is used to sample the current of the robot every n execution cycles to obtain m sampled currents, and then the average value of the current sampled when identifying the initial mass m0 (the first current average value) is compared with the average value of the current sampled currently (the second current average value) to obtain the magnitude of the current difference IqErr. When |IqErr|>|fErr|, it is considered that the torque change of the third axis is caused by the change in the load added to the third axis, and the load mass of the SCARA robot is corrected.

[0085] In a specific implementation, according to the second current average value, using the corresponding relationship between the load mass and the current or the relationship function between the load mass and the current, the mass of the load of the robot is identified and recorded as the first mass; the corrected load mass of the robot is equal to the average of the initial mass and the first mass. For example, the load mass is corrected by the following formula:

[0086]

[0087] m0' is the corrected mass value, m0 is the initial identified mass, and m1 is the identified mass under the mass correction state; the above formula can be understood as the credibility of m0 and m1 is both 1 / 2.

[0088] Furthermore, after the load mass of the SCARA robot is corrected, it is determined whether the absolute value of the difference between the corrected load mass and the mass set by the gravity load instruction is less than a second preset difference; if it is determined that the absolute value of the difference is less than the second preset difference Δm1, the load mass identification will no longer be performed in the enabled state of the SCARA robot until the motor enable of the SCARA robot is 0.

[0089] Specifically, after calculating m0', the mass continues to be updated. When the error range between the identified mass m0' and the mass m2 set by the gravity load instruction is within Δm1 (the mass error judgment condition threshold when stopping mass identification), that is, |m0'-m2|<Δm1, the mass identification will no longer continue in the enabled state until the robot motor is enabled to 0 and the identification is restarted.

[0090] In order to clearly illustrate the technical solution of the present invention, the execution process of the load mass identification method of the SCARA robot provided by the present invention is described below with a specific embodiment.

[0091] Figure 7 The present invention is a method flow chart of a specific embodiment of the method for identifying the load mass of a SCARA robot provided by the present invention.

[0092] like Figure 7 As shown in the figure, when the robot is in position mode, the function switch is valid, when the third-axis servo enable flag is valid, and the position command is 0, the gravity identification function identifies and calculates the initial mass m0, samples the current, collects the third-axis current once every n cycles, collects m times, and then accumulates the m current values. The final current data is the average value of the accumulated current collected m times every n cycles. According to the current average value, the initial mass m0 is identified according to the pre-configured correspondence between the current and the load mass or the pre-fitted correspondence function between the current and the load mass, the cumulative number of times is cleared, the current cumulative value is cleared, and the identified initial mass m0 is saved. The initial identification completion flag position 1 enters state 0, and state 0 is the state where the position command is not 0. When the three-axis servo enable is 0, the cumulative number of times is cleared, the current cumulative value is cleared, m0 is restored to the default, and the initial mass m0 measurement state is jumped.

[0093] When the robot is in position mode, when the enable flag is valid and the position command is not 0, the robot is considered to start running, and m0 is compared with the mass m2 set by the gravity load command. If the absolute value of the difference between the two is outside the range of Δm, an unreasonable setting is generated to prompt the user that the parameters do not match the actual ones, and the process ends. If the absolute value of the difference between the two is within the range of Δm, that is, |m0-m2|<Δm, the quality setting is considered reasonable, and the gravity load command parameters are effective, the initial flag is 1, and enters state 1, which is the load quality correction stage.

[0094] When the initial mass m0 is identified, the initial identification completion flag is 1, and the current difference fErr caused by the friction of the three axes running up and down when the robot is unloaded and the gravity of the three axes themselves is obtained; the current is collected, and then the current used to identify the initial mass m0 is compared with the current collected in the mass correction stage to obtain the size of the current deviation IqErr. When |IqErr|>|fErr| is satisfied, it is considered that the torque change of the three axes is caused by the change in the load added to the three axes, and the mass m0 is corrected: when |IqErr|>|fErr| is not satisfied, there is no need to correct the mass m0.

[0095] After calculating m0', continue to update the mass. When the error range between the identified mass m0' and the mass m2 set by the gravity load instruction is within Δm1 (the mass error judgment condition threshold when stopping mass identification) (|m0'-m2|<Δm1), the mass identification will no longer continue in the enabled state until the robot motor is enabled to 0 and the identification is restarted.

[0096] The invention also provides a load mass identification device for a SCARA robot.

[0097] Figure 8 FIG. 1 is a structural block diagram of an embodiment of a load mass identification device for a SCARA robot provided by the present invention. Figure 8 As shown, the load quality identification device 100 includes: a first acquisition unit 110 , a first identification unit 120 , a first determination unit 130 and a prompt unit 140 .

[0098] The first acquisition unit 110 is used to obtain the corresponding relationship between the load mass and the current of the SCARA robot obtained by pre-testing or the functional relationship between the load mass and the current of the robot obtained by pre-fitting; the current is the third axis current of the robot.

[0099] Specifically, the current is the third axis current of the SCARA robot. Under conditions of different load masses, the magnitude of the third axis current of the robot is collected to obtain a corresponding relationship between the load mass and the current magnitude. The current can specifically be a quadrature axis current. The corresponding relationship can be drawn into a relationship table between the load mass and the current or fitted into a relationship curve between the load mass and the current.

[0100] The functional relationship between the load mass and the current is obtained by performing function fitting based on the corresponding relationship between the load mass and the current of the SCARA robot obtained in the pre-test.

[0101] In a specific implementation, the functional relationship between load mass and current is expressed as:

[0102]

[0103] Torque = force * lever arm, torque = cross-axis current Iq * torque coefficient Kt, so the conversion coefficient a can be understood as the size of the lever arm, a is approximately equal to the lever arm but not equal to the lever arm, so theoretically a is a constant and can be regarded as a coefficient.

[0104] Among them, F is the load mass (unit: kg), Iq is the collected quadrature axis current, Kt is the torque coefficient (taking a 6kg SCARA robot as an example, three-axis Kt = 0.331N m / Arms), and a is the conversion coefficient between load mass and current. The conversion coefficient between load mass and current can be obtained as follows:

[0105]

[0106] Therefore, the conversion coefficient of the load mass and the current in the functional relationship can be obtained according to the corresponding relationship between the load mass and the current. For example, the conversion coefficient a of the load mass and the current can be calculated according to the corresponding relationship table of the load mass and the current of the SCARA robot obtained in advance.

[0107] Since the smaller the load mass, the greater the influence of friction, the lower the load mass, the less accurate the conversion coefficient a will be. Figure 2 The figure shows the relationship between different load masses and conversion coefficients. The horizontal axis represents the load mass, and the vertical axis represents the conversion coefficient between the load mass and the current. Figure 2 It can be seen that the conversion coefficient a tends to be more stable as the load mass increases, so the conversion coefficient a is averaged:

[0108]

[0109] Where i is the load mass, I q(i)is the cross-axis current when the load mass is i, k is the maximum load mass, j is the starting load mass, and starting from j, the cross-axis current I is collected once for each increase of 1kg load q(i) , until i = k. Therefore, the numerator is the sum of the conversion coefficient a with j as the starting load mass and k as the ending load mass, and the denominator is k-j+1. For example, for a 6kg SCARA robot, in order to reduce the impact of friction, j = 3, k = 6 can be taken, and a = 0.03448 is obtained.

[0110] The functional relationship between load mass and current can be obtained as follows:

[0111]

[0112] According to the above formula, the load mass can be calculated by collecting the quadrature-axis current of the robot's motor. The more accurate the table is and the finer the load level division is, the more accurate the conversion coefficient a will be, and the more accurate the identification will be.

[0113] The first identification unit 120 is used to identify the initial mass of the load of the SCARA robot according to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current when the SCARA robot is in the position mode and the enable flag is valid and the position instruction is 0.

[0114] Specifically, when the robot is in the position mode (ie, the control mode in which the input command is the position command), when the enable flag is valid and the position command is 0, the initial mass m0 of the robot load is identified and calculated.

[0115] In a specific embodiment, the first identification unit identifies the initial mass of the load of the SCARA robot according to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current, including: sampling the current of the SCARA robot every n execution cycles to obtain m sampled currents, and calculating an average value of the m sampled currents, recorded as a first current average value; according to the first current average value, using the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current, calculate the initial mass of the load of the SCARA robot.

[0116] Specifically, the current is sampled, and the current data is sampled once every n execution cycles, and the current data is collected m times, and then the m current values ​​are accumulated, and the average value of the accumulated currents collected m times every n cycles is calculated, which is recorded as the first current average value. This can reduce the error caused by more noise on the current, and the current average value is obtained, that is:

[0117]

[0118] in, is the average value of the current sampled m times, that is, the first current average value; T is the execution cycle; Trq i is the current collected every n execution cycles, which is the instantaneous value of the current.

[0119] After obtaining the first current average value, the initial mass of the SACRA robot load corresponding to the first current average value is found by using the corresponding relationship between the load mass and the current, or the initial mass of the SACRA robot load is calculated based on the first current average value and the functional relationship between the load mass and the current. For example, Figure 4 An example of the corresponding relationship between the load mass and the current according to the present invention is shown. The horizontal axis represents the load mass, and the vertical axis represents the current magnitude. Figure 4 The corresponding relationship between the load mass and the current is shown, and the corresponding initial mass m0 is found, or the initial mass m0 is calculated according to the functional relationship between the load mass and the current.

[0120] The first determination unit 130 is used to compare the identified initial mass with the mass set by the gravity load instruction when the SCARA robot is in position mode and the enable flag is valid and the position instruction is not 0, so as to determine whether the setting of the gravity load instruction is reasonable; the prompt unit 140 is used to issue a corresponding prompt message if the determination unit determines that the setting of the gravity load instruction is unreasonable.

[0121] Specifically, when the robot is in position mode, when the enable flag is valid and the position instruction is not 0, the robot is considered to have started running. At this time, the identified initial mass is compared with the mass set by the gravity load instruction to determine whether the setting of the gravity load instruction is reasonable.

[0122] In a specific embodiment, the first determination unit 120 compares the identified initial mass with the mass set by the gravity load instruction to determine whether the setting of the gravity load instruction is reasonable, including: judging whether the absolute value of the difference between the initial mass and the mass set by the gravity load instruction is less than a first preset difference; if the absolute value of the difference is judged to be less than the first preset difference, then judging that the mass setting of the gravity load instruction is reasonable; if the absolute value of the difference is judged to be not less than the first preset difference, then judging that the mass setting of the gravity load instruction is unreasonable.

[0123] The gravity load instruction is an instruction set by the user according to the load at the load end. The instruction includes the load mass and may also include the eccentricity and load inertia. Specifically, m0 is compared with the mass m2 set by the gravity load instruction. If the difference between the two is within the range of the first preset difference Δm (the difference range between the allowable actual mass and the mass set by the gravity load instruction), that is, |m0-m2|<Δm, the load mass setting is considered reasonable and the gravity load parameters are effective. If the difference between the two is outside the range of the first preset difference Δm, the load mass setting is considered unreasonable. If the setting of the gravity load instruction is unreasonable, a corresponding prompt message is issued to prompt the user that the set mass does not match the actual mass.

[0124] Fig. 9 FIG. 1 is a structural block diagram of another embodiment of the load mass identification device of the SCARA robot provided by the present invention. Fig. 9 As shown, the load quality identification device 100 further includes: a second acquisition unit 150 , a second determination unit 160 , a calculation unit 170 , a first judgment unit 180 and a correction unit 190 .

[0125] The second acquisition unit 150 is used to acquire the correspondence between the pre-configured load mass of the SCARA robot and the current difference caused by the friction force of the SCARA robot moving up and down and its own gravity.

[0126] The second determining unit 160 is used to determine the current difference caused by the friction force of the SCARA robot running up and down and its own gravity when the SCARA robot is unloaded according to the corresponding relationship and the first current average value, which is recorded as a first current difference.

[0127] Specifically, the corresponding relationship between the load mass of the SCARA robot and the current difference caused by the friction force of the third axis of the SCARA robot running up and down and its own gravity is obtained in advance through testing. The second acquisition unit 150 acquires the corresponding relationship. For example, Figure 6 The corresponding relationship curve between the load mass of the SCARA robot and the current difference caused by the friction force of the third axis of the SCARA robot running up and down and its own gravity is shown, that is, the different current differences caused by the friction force of the third axis of the SCARA robot running up and down with different load masses and its own gravity. The second determination unit 160 can obtain the current difference caused by the friction force of the SCARA robot running up and down when it is unloaded and its own gravity, that is, the first current difference, according to the above corresponding relationship curve and the first current average value.

[0128] The calculation unit 170 is used to sample the current of the SCARA robot every n execution cycles to obtain m sampled currents, and calculate an average value of the m sampled currents, which is recorded as a second current average value.

[0129] The first judging unit 180 is configured to judge whether an absolute value of a difference between the first current average value and the second current average value is greater than an absolute value of the first current difference.

[0130] The correction unit 190 is used to correct the load mass of the SCARA robot if it is determined that the absolute value of the difference between the first current average value and the second current average value is greater than the absolute value of the first current difference.

[0131] Specifically, the calculation unit 170 adopts the same method as the aforementioned initial mass identification to sample the current of the robot every n execution cycles to obtain m sampled currents, and then uses the average value of the current sampled when identifying the initial mass m0 (the first current average value). The first judgment unit 180 compares the first current average value with the average value of the current currently sampled (the second current average value) to obtain the magnitude of the current difference IqErr (the first current difference). When |IqErr|>|fErr|, it is considered that the torque change of the third axis is caused by the change in the load added to the third axis, and the correction unit 190 corrects the load mass of the SCARA robot.

[0132] In a specific embodiment, the correction unit 190 corrects the load mass of the SCARA robot, including: according to the second current average value, using the corresponding relationship between the load mass and the current or the relationship function between the load mass and the current, identifying the mass of the load of the robot, recorded as the first mass; the corrected load mass of the robot is equal to the average of the initial mass and the first mass.

[0133] For example, the load mass is corrected by the following formula:

[0134]

[0135] m0' is the corrected mass value, m0 is the initial identified mass, and m1 is the identified mass under the mass correction state; the above formula can be understood as the credibility of m0 and m1 is both 1 / 2.

[0136] Furthermore, the device 100 further includes: a second judgment unit.

[0137] The second judgment unit is used to judge whether the absolute value of the difference between the corrected load mass and the mass set by the gravity load instruction is less than a second preset difference after the load mass of the SCARA robot is corrected; if it is judged that the absolute value of the difference is less than the second preset difference, the load mass identification will no longer be continued in the enabled state of the SCARA robot until the motor enable of the SCARA robot is 0.

[0138] Specifically, after calculating m0', the mass continues to be updated. When the error range between the identified mass m0' and the mass m2 set by the gravity load instruction is within Δm1 (the mass error judgment condition threshold when stopping mass identification), that is, |m0'-m2|<Δm1, the mass identification will no longer continue in the enabled state until the robot motor is enabled to 0 and the identification is restarted.

[0139] The present invention also provides a storage medium corresponding to the load mass identification method of the SCARA robot, on which a computer program is stored, and when the computer program is executed by a processor, the steps of any of the aforementioned methods are implemented.

[0140] The present invention also provides a robot controller corresponding to the load mass identification method of the SCARA robot, comprising a processor, a memory, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of any of the aforementioned methods when executing the computer program.

[0141] The present invention also provides a robot controller corresponding to the load mass identification device of the SCARA robot, comprising any of the load mass identification devices described above.

[0142] The present invention also provides a computer program product corresponding to the load mass identification method of the SCARA robot, comprising a computer program, and when the computer program is executed by a processor, the steps of any of the aforementioned methods are implemented.

[0143] Accordingly, the solution provided by the present invention, according to the technical solution of the present invention, collects the motor currents of the three axes of the SCARA robot, and performs initial quality identification on the quality through the correspondence or functional relationship between the current and the quality. When the gravity load instruction setting of the SCARA robot is wrong, the identified load quality and the quality set by the instruction can be compared to prevent abnormal operation caused by a large gap between the robot's servo parameters and operation control parameters and the actual working conditions.

[0144] According to the technical solution of the present invention, based on the different sizes of currents generated when the three axes move up and down, the mass changes during operation are identified, and the initial value of the load mass is continuously corrected to obtain the final mass. The algorithm is simple to implement, does not need to establish a dynamic model, and has strong universality.

[0145] The functions described herein may be implemented in hardware, software executed by a processor, firmware, or any combination thereof. If implemented in software executed by a processor, the functions may be stored as one or more instructions or codes on a computer-readable medium or transmitted via a computer-readable medium. Other examples and implementations are within the scope and spirit of the present invention and the appended claims. For example, due to the nature of software, the functions described above may be implemented using software executed by a processor, hardware, firmware, hard wiring, or a combination of any of these. In addition, each functional unit may be integrated into a processing unit, each unit may exist physically separately, or two or more units may be integrated into one unit.

[0146] In the several embodiments provided in this application, it should be understood that the disclosed technical content can be implemented in other ways. Among them, the device embodiments described above are only schematic. For example, the division of the units can be a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of units or modules, which can be electrical or other forms.

[0147] The units described as separate components may or may not be physically separated, and the components of the control device may or may not be physical units, that is, they may be located in one place or distributed in multiple units. Some or all of the units may be selected according to actual needs to achieve the purpose of the present embodiment.

[0148] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, in essence, or the part that contributes to the relevant technology or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including a number of instructions to enable a computer device (which can be a personal computer, a server or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), mobile hard disk, disk or optical disk and other media that can store program codes.

[0149] The above description is only an embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent substitution, improvement, etc. made within the spirit and principle of the present invention shall be included in the scope of the claims of the present invention.

Claims

1. A method for identifying the load mass of a SCARA robot, characterized in that: include: Obtaining a corresponding relationship between the load mass and the current of the SCARA robot obtained by pre-testing or a functional relationship between the load mass and the current of the SCARA robot obtained by pre-fitting; the current is a third axis current of the robot; When the SCARA robot is in position mode, when the enable flag is valid and the position command is 0, the initial mass of the load of the SCARA robot is identified according to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current; When the SCARA robot is in position mode, when the enable flag is valid and the position command is not 0, the identified initial mass is compared with the mass set by the gravity load command to determine whether the setting of the gravity load command is reasonable; If it is determined that the setting of the gravity load instruction is unreasonable, a corresponding prompt message is issued.

2. The method according to claim 1, characterized in that The functional relationship between the load mass and the current is obtained by performing function fitting based on the corresponding relationship between the load mass and the current of the SCARA robot obtained in the pre-test. The functional relationship between the load mass and the current is expressed as: Where, F is the load mass, Iq is the quadrature axis current, Kt is the torque coefficient, and a is the conversion coefficient between load mass and current; According to the corresponding relationship between the load mass and the current, a conversion coefficient between the load mass and the current in the functional relationship is obtained.

3. The method according to claim 1, characterized in that Comparing the identified initial mass with the mass set by the gravity load instruction to determine whether the setting of the gravity load instruction is reasonable includes: Determining whether an absolute value of a difference between the initial mass and the mass set by the gravity load instruction is less than a first preset difference; If it is determined that the absolute value of the difference is less than the first preset difference, it is determined that the mass setting of the gravity load instruction is reasonable; if it is determined that the absolute value of the difference is not less than the first preset difference, it is determined that the mass setting of the gravity load instruction is unreasonable.

4. The method according to any one of claims 1 to 3, characterized in that: According to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current, the initial mass of the load of the SCARA robot is identified, including: Sampling the current of the SCARA robot every n execution cycles to obtain m sampled currents, and calculating an average value of the m sampled currents, which is recorded as a first current average value; According to the first current average value, the initial mass of the load of the SCARA robot is calculated using the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current.

5. The method according to any one of claims 1 to 3, characterized in that: Also includes: Obtaining a correspondence between a pre-configured load mass of the SCARA robot and a current difference caused by the friction force of the SCARA robot moving up and down and its own gravity; According to the corresponding relationship and the first current average value, a current difference caused by the friction force of the SCARA robot running up and down when the robot is unloaded and its own gravity is determined, which is recorded as a first current difference; Sampling the current of the SCARA robot every n execution cycles to obtain m sampled currents, and calculating an average value of the m sampled currents, which is recorded as a second current average value; Determining whether an absolute value of a difference between the first current average value and the second current average value is greater than an absolute value of the first current difference; If it is determined that the absolute value of the difference between the first current average value and the second current average value is greater than the absolute value of the first current difference, the load mass of the SCARA robot is corrected.

6. The method according to claim 5, characterized in that The load mass of the SCARA robot is corrected, including: According to the second current average value, using the corresponding relationship between the load mass and the current or the relationship function between the load mass and the current, the mass of the load of the robot is identified and recorded as the first mass; The corrected load mass of the robot is equal to an average value of the initial mass and the first mass.

7. The method according to claim 5 or 6, characterized in that: After correcting the load mass of the SCARA robot, determining whether the absolute value of the difference between the corrected load mass and the mass set by the gravity load instruction is less than a second preset difference; If it is determined that the absolute value of the difference is less than the second preset difference, the load mass identification is no longer performed in the enabled state of the SCARA robot until the motor enable of the SCARA robot is 0.

8. A load mass identification device for a SCARA robot, characterized in that: include: A first acquisition unit is used to acquire a corresponding relationship between the load mass and the current of the SCARA robot obtained by pre-testing or a functional relationship between the load mass and the current of the robot obtained by pre-fitting; the current is a third axis current of the robot; A first identification unit is used to identify the initial mass of the load of the SCARA robot according to the corresponding relationship between the load mass and the current or the functional relationship between the load mass and the current when the SCARA robot is in the position mode and the enable flag is valid and the position instruction is 0; A first determination unit is used to compare the identified initial mass with the mass set by the gravity load instruction when the SCARA robot is in position mode and the enable flag is valid and the position instruction is not 0, to determine whether the setting of the gravity load instruction is reasonable; The prompting unit is configured to issue a corresponding prompting message if the determining unit determines that the setting of the gravity load instruction is unreasonable.

9. A computer-readable storage medium, characterized in that: A computer program is stored thereon, and when the program is executed by a processor, the steps of any method described in claims 1-7 are implemented.

10. A robot controller, characterized in that: The method comprises a processor, a memory and a computer program stored in the memory and executable on the processor. When the processor executes the program, the steps of any method described in claims 1 to 7 are implemented, or the load quality identification device described in claim 8 is included.

11. A computer program product, characterized in that The invention comprises a computer program, which implements the steps of any one of the methods of claims 1 to 7 when being executed by a processor.

Citation Information

Patent Citations

  • Gravity compensation method and device, storage medium and robot

    CN108972626A

  • Load estimation gravity compensation method and system for mechanical arm

    CN109773827A

  • Robot tail end load identification method and system based on joint torque balance

    CN117381796A

  • Load parameter detection method and device, storage medium and collaborative robot

    CN117444957A

  • Speed controller for servomotor

    JP1994284763A