Method and device for identifying dynamic parameters of SCARA robot

By using a step-by-step identification method, specific motion trajectories are designed for the friction coefficient and inertial parameters of the SCARA robot, which solves the problem of poor identification accuracy of dynamic parameters in the existing technology and improves the identification accuracy of dynamic parameters of the SCARA robot.

CN113681551BActive Publication Date: 2024-11-12KUKA ROBOTICS MFG CHINA CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202010421010.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2020-05-18
Publication Date
2024-11-12
Estimated Expiration
2040-05-18

AI Technical Summary

Technical Problem

Existing technologies cannot guarantee that the excitation trajectory identified by the dynamic parameters of SCARA robots is optimal, and the accuracy of the identified dynamic parameters is poor.

Method used

The step-by-step identification method is adopted to determine the friction coefficient and inertial parameters of the SCARA robot separately. By designing specific motion trajectories, the friction coefficient and inertial parameters of each joint are identified separately, avoiding the problem of finding the optimal trajectory and large numbers swallowing small numbers in one-time identification.

Benefits of technology

This improves the accuracy of SCARA robot dynamic parameter identification, avoids the problems of optimizing the excitation trajectory and large numbers consuming small numbers, and achieves higher identification accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN113681551B_ABST
    Figure CN113681551B_ABST
Patent Text Reader

Abstract

The embodiment of the present application provides a method and device for identifying the dynamic parameters of a SCARA robot. The method includes: obtaining the minimum inertia parameter set dynamic model of the SCARA robot with friction terms; determining the friction coefficient identification trajectory of each joint according to the minimum inertia parameter set dynamic model, and identifying the friction coefficient of each joint based on the friction coefficient identification trajectory; determining the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamic model, and identifying the inertia parameters of each joint based on the inertia parameter identification trajectory. The technical solution of the embodiment of the present application can improve the identification accuracy of the dynamic parameters of the SCARA robot.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of dynamic control optimization of SCARA robots, and in particular to a method and device for identifying dynamic parameters of a SCARA robot. Background Art

[0002] With the development of robot technology, industrial robots have been widely used in various links of industrial production. As a typical four-degree-of-freedom industrial robot, SCARA robot is widely used in sorting, palletizing, spraying, assembly and other fields. In the field of robot motion control, the three issues of stability, accuracy and speed have always been the core issues. In order to ensure the stability and motion accuracy of the robot during movement, many high-performance industrial robots often compensate the output torque of each joint of the robot according to the robot's dynamic model. The accuracy of the robot's dynamic parameters determines the accuracy of this compensation torque.

[0003] However, the existing methods for obtaining the dynamic parameters of the robot have the disadvantages of being difficult to ensure the optimal excitation trajectory and having poor accuracy in the identified dynamic parameters. Summary of the invention

[0004] The embodiments of the present application provide a method and device for identifying the dynamic parameters of a SCARA robot, thereby being able to improve the identification accuracy of the dynamic parameters of the SCARA robot at least to a certain extent.

[0005] Other features and advantages of the present application will become apparent from the following detailed description, or may be learned in part by the practice of the present application.

[0006] According to one aspect of an embodiment of the present application, a method for identifying dynamic parameters of a SCARA robot is provided, wherein the SCARA robot includes four joints, wherein joint one, joint two and joint four are rotating joints, and joint three is a moving joint, and the method includes: obtaining a minimum inertia parameter set dynamic model of the SCARA robot with a friction term; determining a friction coefficient identification trajectory of each joint according to the minimum inertia parameter set dynamic model, and identifying the friction coefficient of each joint based on the friction coefficient identification trajectory; determining an inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamic model, and identifying the inertia parameters of each joint based on the inertia parameter identification trajectory.

[0007] According to one aspect of an embodiment of the present application, a device for identifying dynamic parameters of a SCARA robot is provided, wherein the SCARA robot includes four joints, wherein joint one, joint two and joint four are rotating joints, and joint three is a moving joint, and comprises: an acquisition unit, configured to acquire a minimum inertia parameter set dynamic model with a friction term of the SCARA robot; a first determination and identification unit, configured to determine a friction coefficient identification trajectory of each joint according to the minimum inertia parameter set dynamic model, and identify the friction coefficient of each joint based on the friction coefficient identification trajectory; a second determination and identification unit, configured to determine an inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamic model, and identify the inertia parameters of each joint based on the inertia parameter identification trajectory.

[0008] In some embodiments of the present application, based on the aforementioned scheme, the first determination and identification unit is configured to identify the friction coefficient of each joint as the trajectory of the other three joints being locked when each joint performs forward and reverse uniform motion. The first determination and identification unit includes: an acquisition subunit, configured to acquire motion data of each joint performing forward and reverse uniform motion; a fitting subunit, configured to fit the motion straight line graph of each joint according to the acquired motion data; a friction coefficient determination subunit, configured to use the slope of the motion straight line graph as the viscous friction coefficient of each joint, and determine the Coulomb friction coefficient of each joint according to the vertical intercept of the motion straight line graph; a processing subunit, configured to obtain the friction coefficient of each joint according to the viscous friction coefficient of each joint and the Coulomb friction coefficient of each joint.

[0009] In some embodiments of the present application, based on the aforementioned scheme, the friction coefficient determination subunit is configured as: if the joint performing forward and reverse uniform motion is any of the rotational joints, the absolute value of any vertical intercept of the motion straight line graph is used as the Coulomb friction coefficient of the rotational joint; if the joint performing forward and reverse uniform motion is the moving joint, the average value of the absolute values ​​of the two vertical intercepts of the motion straight line graph is calculated, and the average value is used as the Coulomb friction coefficient of the moving joint.

[0010] In some embodiments of the present application, based on the aforementioned scheme, the second determination and identification unit is configured as: determining the first inertia parameter identification trajectory of the joint four according to the dynamic equation of the joint four in the minimum inertia parameter set dynamic model, the first inertia parameter identification trajectory of the joint four being the trajectory when the joint four performs uniformly accelerated motion and the joint one, the joint two and the joint three are all locked; collecting the current generated by the uniformly accelerated motion of the joint four, and converting the current into the first joint torque of the joint four; calculating the first inertia parameter of the joint four according to the first joint torque of the joint four.

[0011] In some embodiments of the present application, based on the aforementioned scheme, the second determination and identification unit is configured as: determining the second inertia parameter identification trajectory of the joint four according to the dynamic equation of the joint four in the minimum inertia parameter set dynamic model, the second inertia parameter identification trajectory of the joint four being the trajectory when the joint two and the joint four are both moving at a uniform speed and the joint one and the joint three are both locked; collecting the current generated by the uniform motion of the joint four, and converting the current into the second joint torque of the joint four; calculating the second inertia parameter of the joint four according to the second joint torque of the joint four.

[0012] In some embodiments of the present application, based on the aforementioned scheme, the second determination and identification unit is configured as: determining the first inertia parameter identification trajectory of the joint two according to the dynamic equation of the joint two in the minimum inertia parameter set dynamic model, the first inertia parameter identification trajectory of the joint two being the trajectory of the joint one, the joint three and the joint four being locked when the joint two performs uniformly accelerated motion; collecting the current generated by the uniformly accelerated motion of the joint two, and converting the current into the first joint torque of the joint two; calculating the first inertia parameter of the joint two according to the first joint torque of the joint two, the first inertia parameter of the joint four and the second inertia parameter of the joint four.

[0013] In some embodiments of the present application, based on the aforementioned scheme, the second determination and identification unit is configured as: determining the second inertia parameter identification trajectory of the joint two according to the dynamic equation of the joint two in the minimum inertia parameter set dynamic model, the second inertia parameter identification trajectory of the joint two being the trajectory when the joint one and the joint two are both moving at a uniform speed and the joint three and the joint four are both locked; collecting the current generated by the uniform motion of the joint two, and converting the current into the second joint torque of the joint two; calculating the second inertia parameter of the joint two according to the second joint torque of the joint two and the second inertia parameter of the joint four.

[0014] In some embodiments of the present application, based on the aforementioned scheme, the second determination and identification unit is configured as: determining the inertia parameter identification trajectory of the joint one according to the dynamic equation of the joint one in the minimum inertia parameter set dynamic model, the inertia parameter identification trajectory of the joint one being the trajectory when the joint one performs uniform acceleration motion and the joint two, the joint three and the joint four are all locked; collecting the current generated by the uniform acceleration motion of the joint one, and converting the current into the joint torque of the joint one; calculating the inertia parameter of the joint one according to the joint torque of the joint one, the first inertia parameter of the joint four, the second inertia parameter of the joint four, the first inertia parameter of the joint two and the second inertia parameter of the joint two.

[0015] In some embodiments of the present application, based on the aforementioned scheme, the second determination and identification unit is configured as: determining the inertia parameter identification trajectory of the joint three according to the dynamic equation of the joint three in the minimum inertia parameter set dynamic model, the inertia parameter identification trajectory of the joint three being the trajectory when the joint three performs uniform acceleration motion and the joint one, the joint two and the joint four are all locked; collecting the current generated by the uniform motion of the joint three, and converting the current into the joint force of the joint three; calculating the inertia parameters of the joint three according to the joint force of the joint three.

[0016] In the technical solutions provided in some embodiments of the present application, the friction coefficient of each joint is identified by identifying the trajectory of the friction coefficient of each joint, and the inertia parameters of each joint are identified based on the trajectory of the inertia parameters of each joint, thereby avoiding the problem of difficulty in finding the optimal trajectory in the excitation trajectory when using a one-time identification solution. By using this separate identification method, each identification process has a specific friction coefficient or inertia parameter, thereby avoiding the problem of large numbers eating small numbers in a one-time identification, and improving the identification accuracy of the SCARA robot's dynamic parameters.

[0017] It should be understood that the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the present application. BRIEF DESCRIPTION OF THE DRAWINGS

[0018] The drawings herein are incorporated into the specification and constitute a part of the specification, showing embodiments consistent with the present application, and together with the specification, are used to explain the principles of the present application. Obviously, the drawings described below are only some embodiments of the present application, and for ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work. In the drawings:

[0019] Figure 1 A schematic diagram of the structure of a SCARA robot according to an embodiment of the present application is shown;

[0020] Figure 2 A SCARA robot connecting rod coordinate system diagram of an embodiment of the present application is shown;

[0021] Figure 3 A flow chart of a method for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown;

[0022] Figure 4 A flow chart of a method for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown;

[0023] Figure 5 A flow chart of a method for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown;

[0024] Figure 6 A flow chart of a method for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown;

[0025] Figure 7 A flow chart of a method for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown;

[0026] Figure 8 A flow chart of a method for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown;

[0027] Fig. 9 A flow chart of a method for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown;

[0028] Fig.10 A flow chart of a method for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown;

[0029] Fig.11 An interactive flow chart of a method for identifying a friction coefficient of a SCARA robot according to an embodiment of the present application is shown;

[0030] Fig.12 shows a motion straight line diagram obtained by fitting according to an embodiment of the present application;

[0031] Fig.13 shows a motion straight line diagram obtained by fitting according to another embodiment of the present application;

[0032] Fig.14 A block diagram of a device for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown;

[0033] Fig.15A schematic diagram of the structure of a computer system suitable for implementing an electronic device of an embodiment of the present application is shown. DETAILED DESCRIPTION

[0034] Example embodiments will now be described more fully with reference to the accompanying drawings. However, example embodiments can be implemented in a variety of forms and should not be construed as limited to the examples set forth herein; rather, these embodiments are provided so that this application will be more comprehensive and complete and fully convey the concept of the example embodiments to those skilled in the art.

[0035] In addition, described feature, structure or characteristic can be combined in one or more embodiments in any suitable manner. In the following description, many specific details are provided to provide a full understanding of the embodiments of the present application. However, those skilled in the art will appreciate that the technical scheme of the present application can be put into practice without one or more of the specific details, or other methods, components, devices, steps, etc. can be adopted. In other cases, known methods, devices, realizations or operations are not shown or described in detail to avoid blurring the various aspects of the application.

[0036] The block diagrams shown in the accompanying drawings are merely functional entities and do not necessarily correspond to physically independent entities. That is, these functional entities may be implemented in software form, or in one or more hardware modules or integrated circuits, or in different networks and / or processor devices and / or microcontroller devices.

[0037] The flowcharts shown in the accompanying drawings are only exemplary and do not necessarily include all the contents and operations / steps, nor must they be executed in the order described. For example, some operations / steps can be decomposed, and some operations / steps can be combined or partially combined, so the actual execution order may change according to actual conditions.

[0038] Before further describing the embodiments of the present application in detail, the nouns involved in the embodiments of the present application are explained. The nouns involved in the embodiments of the present application are subject to the following interpretations.

[0039] The SCARA robot (Selective Compliance Assembly Robot Arm), also known as a planar articulated robot, is a special type of industrial robot with cylindrical coordinates. It uses three rotating joints to achieve positioning and orientation within the plane and one moving joint to achieve vertical lifting and lowering movement at the end.

[0040] Figure 1 The schematic diagram of the SCARA robot structure of the embodiment of the present application is shown. Figure 2The SCARA robot connecting rod coordinate system diagram of the embodiment of the present application is shown. Figure 1 and Figure 2 It can be seen that joint 1, joint 2 and joint 4 are rotation joints, the angle of rotation of joint 1 around the axis is θ1, the angle of rotation of joint 2 around the axis is θ2, the angle of rotation of joint 4 around the axis is θ3, joint 3 is a translation joint, the length of the connecting rod between joint 1 and joint 2 is l1, the length of the connecting rod between joint 2 and joint 3 is l2, and joints 3 and joints 4 share a connecting rod with a length of d3.

[0041] In the research field of dynamic parameter identification of industrial robots, the existing identification scheme is mainly the excitation trajectory identification scheme. In this scheme, the dynamic model of the robot is first established; then a suitable periodic finite-term Fourier series is selected as the excitation trajectory, and the robot's joints move according to the excitation trajectory. The joint angle, angular velocity, angular acceleration, joint torque and other parameters are collected, filtered and calculated through encoders and torque sensors; finally, the dynamic parameters in the dynamic equation are calculated by the least squares method.

[0042] In order to obtain a better excitation trajectory, the existing technical solutions also include solutions that use different optimization schemes to optimize the excitation trajectory. For example, the d-optimal standard minimization method is used to optimize the identification trajectory of the industrial robot dynamics model, or the niche genetic algorithm with an exclusion mechanism is used to optimize the coefficients of the Fourier series to minimize the condition number of the observation matrix to obtain the optimized excitation trajectory.

[0043] However, there are two problems in the existing excitation trajectory identification scheme:

[0044] 1. The optimization algorithm cannot guarantee the optimal incentive trajectory

[0045] For nonlinear optimization problems such as optimizing Fourier series coefficients, the complexity of solving them will increase exponentially with the increase of the number of joints. Moreover, the optimization results are affected by the settings of various optimization parameters. For example, in the niche genetic algorithm, the design of the fitness function and the probability of crossover mutation directly affect the optimization results of the excitation trajectory. Improper parameter settings may make it difficult for the optimization algorithm to converge or converge to a local optimum, and ultimately obtain a poor excitation trajectory.

[0046] 2. The final identified dynamic parameters have poor accuracy

[0047] The identification method of the excitation trajectory is adopted to put the inertia parameters and friction parameters of all joints into a set of equations and solve them by the least square method. This will lead to the situation that the large number eats the small number in the solution matrix: the dynamic parameters with larger parameters cause large torque changes and torque noise, while the torque changes caused by the dynamic parameters with smaller parameters will be masked by the torque noise of these larger parameters. For such small dynamic parameters, the exact value cannot be identified.

[0048] In order to solve the problem of poor accuracy in identifying the dynamic parameters of the SCARA robot, this application separately identifies the inertia parameters and friction coefficient of each joint of the SCARA robot, and adopts a step-by-step identification method to design a specific motion trajectory for the inertia parameters and friction coefficient of each joint, and identifies the inertia parameters and friction coefficient of each joint in turn. Figure 3 A flow chart of a method for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown, referring to Figure 3 As shown, the method includes:

[0049] Step S310, obtaining a minimum inertia parameter set dynamic model of the SCARA robot with a friction term;

[0050] Step S320, determining the friction coefficient identification trajectory of each joint according to the minimum inertia parameter set dynamics model, and identifying the friction coefficient of each joint based on the friction coefficient identification trajectory;

[0051] Step S330: determining the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model, and identifying the inertia parameters of each joint based on the inertia parameter identification trajectory.

[0052] These steps are described in detail below.

[0053] In step S310, a minimum inertia parameter set dynamic model of the SCARA robot with friction terms is obtained.

[0054] As mentioned above, the SCARA robot includes four joints, among which joints 1, 2 and 4 are rotational joints, and joint 3 is a mobile joint. Before identifying the inertia parameters of each joint of the SCARA robot and the friction coefficient of each joint, the dynamic model of the minimum inertia parameter set of the SCARA robot with friction terms can be obtained.

[0055] In one embodiment, the method of obtaining the minimum inertia parameter set dynamic model of the SCARA robot with friction term may include:

[0056] Establishing a dynamic model of the SCARA robot with friction terms;

[0057] The dynamic model is linearized to obtain the minimum inertia parameter set dynamic model of the SCARA robot with friction terms.

[0058] In this embodiment, firstly, a linear dynamic model Fc of the SCARA robot with friction terms is established using a classical friction model:

[0059]

[0060] Where Fc is the joint friction force, f c is the Coulomb friction coefficient, f v is the viscous friction coefficient, is the joint angular velocity (for moving joints, is the joint linear velocity), sng(1) is the step function.

[0061] Secondly, based on the Newton-Euler dynamics equation, the dynamic model of the SCARA robot with friction term can be derived as τ:

[0062]

[0063] Where τ is the joint torque, is the inertia term, D(q) is the inertia matrix, is the acceleration vector of each joint, is the Coriolis term, is the Coriolis force matrix, q is the joint position vector, is the joint velocity vector, and G(q) is the gravity term.

[0064] Again, by linearizing Formula 2, we can deduce the minimum parameter set of the inertial parameters of the SCARA robot:

[0065] I ZZ4 ,mr x4 ,mr y4

[0066] m3+m4

[0067] (I ZZ2 +I ZZ3 +2·l2·mr x3 ),(mr x2 +mr x3 ),(mr y2 -mr y3 )

[0068]

[0069] Furthermore, according to the joint motion related to the minimum inertia parameter set, the minimum inertia parameter set dynamic model of the SCARA robot with friction terms is obtained, which is composed of the dynamic equations of the four joints of the SCARA robot, as shown in the following formula (3).

[0070]

[0071] It needs to be explained that I xxi ,I xyi ,I xzi ,I yyi ,I yzi ,I zzi are the six parameters of the inertia matrix of link i, mr xi ,mr yi ,mr zi is the mass of the connecting rod m i and the three components of the centroid coordinates r xi ,r yi ,r zi The product of i is the position vector of joint i, is the velocity vector of joint i, is the acceleration vector of joint i, l1 is the length of link 1, l2 is the length of link 2, g is the acceleration due to gravity, and since joint 3 is a mobile joint, it is the joint force of joint 3. is the linear acceleration of joint three.

[0072] Step S320: determining the friction coefficient identification trajectory of each joint according to the minimum inertia parameter set dynamics model, and identifying the friction coefficient of each joint based on the friction coefficient identification trajectory.

[0073] Specifically, the friction coefficient refers to the ratio of the friction force between two surfaces and the vertical force acting on one of the surfaces. The friction coefficient identification trajectory refers to the trajectory designed for the robot to identify the friction coefficient. The friction coefficient of the SCARA robot includes the friction coefficients of four joints. Therefore, the friction coefficient identification trajectory of each joint of the SCARA robot can be determined separately according to the dynamic equations of the four joints in the minimum inertia parameter set dynamics model. Then, the friction coefficient of each joint can be identified step by step according to the friction coefficient identification trajectory of each joint.

[0074] It is understandable that the friction coefficient identification trajectory of each joint can be any motion trajectory of the robot designed to identify the friction coefficient of each joint, and the present application embodiment is not limited here. In one embodiment of the present application, in order to identify the friction coefficient of each joint, the trajectory of the designed robot can be a trajectory that satisfies the conservation relationship between the joint friction force and the joint output torque.

[0075] Step S330: determining the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model, and identifying the inertia parameters of each joint based on the inertia parameter identification trajectory.

[0076] Similarly, the inertia parameter identification trajectory refers to the trajectory designed for the robot in order to identify the inertia parameters. For the SCARA robot, each joint has a corresponding inertia parameter. From the dynamic equations of the four joints in the minimum inertia parameter set dynamic model, it can be seen that the inertia parameter of joint four is I ZZ4 ,mr x4 ,mr y4 , the inertia parameter of joint three is m3+m4, and the inertia parameter of joint two is (I ZZ2 +I ZZ3 +2·l2·mr x3 ),(mr x2 +mr x3 ),(mr y2 -mr y3 ), the inertia parameter of joint 1 is (m2·l1 2 +I ZZ1 ), therefore, the dynamic equations of the four joints in the minimum inertia parameter set dynamics model can be combined to determine the inertia parameter identification trajectories of the four joints of the SCARA robot respectively, and then, based on the inertia parameter identification trajectories of the four joints, the inertia parameters corresponding to the four joints can be identified step by step.

[0077] Among them, the inertia parameter identification trajectory of each joint can be any motion trajectory of the robot designed to identify the inertia parameters of each joint, and the embodiment of the present application is not limited here.

[0078] Through the technical solution of the above embodiment, the friction coefficient of each joint is identified through the friction coefficient identification trajectory of each joint, and the inertia parameter identification trajectory of each joint is identified to identify the inertia parameter of each joint, thereby avoiding the problem of difficulty in finding the optimal trajectory by the excitation trajectory when adopting a one-time identification scheme. By adopting this separate identification method, each identification process has a specific friction coefficient or inertia parameter, thereby avoiding the problem of large numbers eating small numbers in one-time identification, and improving the identification accuracy of the SCARA robot's dynamic parameters.

[0079] In one embodiment of the present application, it can be seen from the dynamic equations in the minimum inertia parameter set dynamics model that when a single joint of the SCARA robot moves at a uniform speed and the other three joints are locked, the friction force and joint output torque of this joint are conserved. Therefore, the friction coefficient identification trajectory of each joint can be the trajectory of each joint when the other three joints are locked while the joints are moving at a uniform speed in both directions. Thus, Figure 4As shown, based on the friction coefficient identification trajectory, identifying the friction coefficient of each joint may include steps S410 to S440, which are described in detail as follows:

[0080] Step S410: collecting motion data of each joint performing forward and reverse uniform motion.

[0081] In this embodiment, since the identification trajectory of the friction coefficient of each joint is that the joint moves at a uniform speed and the trajectories of the other three joints are locked, when identifying the friction coefficient of joint one, joint one can be allowed to move at a uniform speed, and joints two, three and four can be locked; when identifying the friction coefficient of joint two, joint two can be allowed to move at a uniform speed, and joints one, three and four can be locked; when identifying the friction coefficient of joint three, joint three can be allowed to move at a uniform speed, and joints one, two and four can be locked; when identifying the friction coefficient of joint four, joint four can be allowed to move at a uniform speed, and joints one, two and three can be locked.

[0082] The forward and reverse uniform motion of each joint may be a plurality of groups of forward and reverse uniform motions at different speeds. For example, the motion data of four groups of motions of joint 1 with forward and reverse speeds of (10, -10), (20, -20), (30, -30), and (40, -40) are collected. The collected motion data may include joint torque or joint force. Since joint 3 is a mobile joint and the motion speed is a linear speed, the current of joint 3 that performs forward and reverse uniform motion is collected and can be converted into the joint force of joint 3 after filtering and other processing. Joint 1, joint 2, and joint 4 are rotating joints and the motion speed is an angular velocity. Therefore, the current of joint 1 that performs forward and reverse uniform motion is collected and can be converted into the joint torque of joint 1 after filtering processing. The current of joint 2 that performs forward and reverse uniform motion is collected and can be converted into the joint torque of joint 2 after filtering processing. The current of joint 4 that performs forward and reverse uniform motion is collected and can be converted into the joint torque of joint 4 after filtering processing.

[0083] Step S420: fitting the motion straight line graphs of the joints according to the collected motion data.

[0084] As mentioned above, the collected motion data may include the joint force of joint three, or may include the joint torque of joint one, the joint torque of joint two, and the joint torque of joint four.

[0085] Therefore, when identifying the friction coefficient of joint one, that is, when joint one moves at a uniform speed and joints two, three and four are all locked, a motion straight line graph can be obtained according to the joint torque of joint one and the speed of joint one. The motion straight line graph is also the speed-torque graph of joint one.

[0086] When identifying the friction coefficient of joint two, that is, when joint two moves at a uniform speed and joints one, three and four are all locked, a motion straight line graph can be obtained according to the joint torque of joint two and the speed of joint two. The motion straight line graph is also the speed-torque graph of joint two.

[0087] When identifying the friction coefficient of joint three, that is, when joint three moves at a uniform speed and joints one, two and four are all locked, a motion straight line graph can be fitted according to the joint force of joint three and the speed of joint three. The motion straight line graph is also the speed-torque graph of joint three.

[0088] When identifying the friction coefficient of joint four, that is, when joint four moves at a uniform speed and joints one, two and three are all locked, a motion straight line graph can be obtained according to the joint torque of joint four and the speed of joint four. The motion straight line graph is also the speed-torque graph of joint four.

[0089] It is understandable that when multiple sets of forward and reverse uniform motion data of each joint are collected, multiple sets of motion straight line graphs of each joint can be obtained by fitting according to the collected motion data.

[0090] Step S430: using the slope of the motion straight line graph as the viscous friction coefficient of each joint, and determining the Coulomb friction coefficient of each joint according to the vertical intercept of the motion straight line graph.

[0091] Specifically, after fitting the motion straight line graph of each joint, the slope of the motion straight line graph of each joint can be calculated, and the calculated slope can be used as the viscous friction coefficient of each joint. Based on the vertical intercept of the motion straight line graph of each joint, the Coulomb friction coefficient of each joint can be determined. For example, any of the two vertical intercepts of the motion straight line graph can be directly used as the Coulomb friction coefficient, or the average of the two vertical intercepts of the motion straight line graph can be used as the Coulomb friction coefficient.

[0092] In one embodiment of the present application, determining the Coulomb friction coefficient of each joint according to the vertical intercept of the motion straight line graph may include:

[0093] If the joint that performs forward and reverse uniform motion is any of the rotational joints, the absolute value of any vertical intercept of the motion straight line graph is taken as the Coulomb friction coefficient of the rotational joint;

[0094] If the joint performing forward and reverse uniform motion is the moving joint, the average value of the absolute values ​​of the two vertical intercepts of the motion straight line graph is calculated, and the average value is used as the Coulomb friction coefficient of the moving joint.

[0095] In this embodiment, the Coulomb friction coefficient of the joint can be determined in combination with the properties of the joint. Specifically, if the joint performing forward and reverse uniform motion is any rotational joint, the rotational joint includes joint one, joint two and joint four. As mentioned above, the speed-torque diagram of joint one can be fitted by collecting the movement speed of joint one performing forward and reverse uniform motion, the speed-torque diagram of joint two can be fitted by collecting the movement speed of joint two performing forward and reverse uniform motion, and the speed-torque diagram of joint four can be fitted by collecting the movement speed of joint four performing forward and reverse uniform motion. Therefore, if the joint performing forward and reverse uniform motion is joint one, joint two or joint four, the absolute value of any vertical intercept of the corresponding speed-torque diagram can be used as the Coulomb friction coefficient of the corresponding joint.

[0096] It should be noted that, in the velocity-torque diagram of the revolute joint, the absolute values ​​of the two vertical intercepts are approximately equal, so the absolute value of any vertical intercept can be used as the Coulomb friction coefficient.

[0097] On the contrary, if the joint performing forward and reverse uniform motion is a mobile joint, that is, joint three, as mentioned above, the velocity-force diagram of joint three can be fitted through the motion data of joint three. Since the motion of joint three is affected by the gravity term, the absolute values ​​of the two vertical intercepts in the velocity-force diagram of joint three are not equal. Therefore, the average value of the absolute values ​​of the two vertical intercepts can be calculated, and the calculated average value is used as the Coulomb friction coefficient of mobile joint three.

[0098] Step S440: Obtain the friction coefficient of each joint according to the viscous friction coefficient of each joint and the Coulomb friction coefficient of each joint.

[0099] It should be explained that the friction coefficient of each joint includes the viscous friction coefficient and the Coulomb friction coefficient. Therefore, after obtaining the viscous friction coefficient and the Coulomb friction coefficient of each joint through step S430, the friction coefficient of each joint is also obtained.

[0100] In one embodiment of the present application, in addition to determining the friction coefficient identification trajectory of each joint according to the minimum inertia parameter set dynamics model, the inertia parameter identification trajectory of each joint can also be determined according to the minimum inertia parameter set dynamics model, and based on the inertia parameter identification trajectory of each joint, the inertia parameters of each joint can be identified, such as Figure 5 As shown, step S330 specifically includes:

[0101] Step S510, determining a first inertia parameter identification trajectory of the joint 4 according to the dynamic equation of the joint 4 in the minimum inertia parameter set dynamic model, wherein the first inertia parameter identification trajectory of the joint 4 is a trajectory in which the joint 1, the joint 2 and the joint 3 are all locked when the joint 4 performs uniform acceleration motion;

[0102] Step S520, collecting the current generated by the uniform acceleration motion of the joint 4, and converting the current into the first joint torque of the joint 4;

[0103] Step S530: Calculate the first inertia parameter of the joint four according to the first joint torque of the joint four.

[0104] In step S510, as described above, the inertia parameters of joint 4 include I ZZ4 ,mr x4 ,mr y4 , from the dynamic equation of joint 4 in the above formula (3), the first inertia parameter identification trajectory of joint 4 can be determined. It is easy to understand that the inertia parameter identification trajectory is a trajectory designed for the robot to identify the inertia parameters, and the first inertia parameter identification trajectory of joint 4 is to identify the inertia parameter I ZZ4 As for the trajectory designed for the robot, according to the dynamic equation of joint four in formula (3), the first inertia parameter identification trajectory of joint four can be determined as a trajectory that makes joint four of the SCARA robot perform uniform acceleration motion and joints one, two and three are all locked.

[0105] Step S520: collecting the current generated by the uniform acceleration motion of the joint four, and converting the current into the first joint torque of the joint four.

[0106] Since only joint four performs uniform acceleration motion in the first inertia parameter identification trajectory of joint four, the current generated by the uniform acceleration motion of joint four can be collected, and the collected current can be converted into the first joint torque of joint four through filtering and other processing.

[0107] Step S530: Calculate the first inertia parameter of the joint four according to the first joint torque.

[0108] According to the first inertial parameter identification trajectory of joint 4, when joint 1, joint 2 and joint 3 are all locked, the position vector, velocity vector and acceleration vector of joint 1, joint 2 and joint 3 are all zero. Therefore, the dynamic equation of joint 4 in the above formula (3) can be simplified to Among them, Fc4 is the friction force of joint four, and Fc4 is a known item.

[0109] Since the first joint torque τ4 of joint 4 is obtained in step S520, and When Fc4 is a known term, the simplified dynamic equation of joint 4 can be solved to obtain the first inertia parameter I of joint 4. ZZ4 .

[0110] In one embodiment of the present application, after identifying the first inertia parameter I of the joint 4 ZZ4 After that, the second inertia parameter identification trajectory of joint 4 can be determined based on the dynamic equation of joint 4 in the minimum inertia parameter set dynamic model, and then the second inertia parameter mr of joint 4 can be identified based on the second inertia parameter identification trajectory of joint 4. x4 ,mr y4 ,like Figure 6 As shown, step S330 specifically includes steps S610 to S630, which are described in detail as follows:

[0111] Step S610, determining the second inertia parameter identification trajectory of the joint four according to the dynamic equation of the joint four in the minimum inertia parameter set dynamic model, the second inertia parameter identification trajectory of the joint four being the trajectory when the joint two and the joint four are both moving at a uniform speed and the joint one and the joint three are both locked.

[0112] In order to identify the second inertia parameter mr of joint 4 x4 ,mr y4 First, the second inertia parameter identification trajectory of joint four can be determined according to the dynamic equation of joint four in the above formula (3). The second inertia parameter identification trajectory of joint four is a trajectory designed for the robot to identify the second inertia parameters of joint four. According to the dynamic equation of joint four, the second inertia parameter identification trajectory of joint four can be determined as a trajectory that makes joints two and four of the SCARA robot move at a uniform speed, and joints one and three are locked.

[0113] Step S620, collecting the current generated by the uniform motion of the joint four, and converting the current into the second joint torque of the joint four.

[0114] Although joint four and joint two both move at a uniform speed in the second inertia parameter identification trajectory of joint four, since only the second inertia parameter identification trajectory of joint four is needed to identify the second inertia parameter of joint four, it is possible to only collect the current generated by the uniform motion of joint four, and convert the collected current into the second joint torque of joint four through filtering and other processing.

[0115] Step S630: Calculate the second inertia parameter of the joint four according to the second joint torque of the joint four.

[0116] According to the second inertial parameter identification trajectory of joint 4, when joint 1 and joint 3 are locked, the position vector, velocity vector and acceleration vector of joint 1 and joint 3 are all zero. At this time, according to the above formula (3), the dynamic equation of joint 4 can be obtained as follows:

[0117]

[0118] Since the second joint torque τ4 of joint 4 is obtained in step S620, in the dynamic equation of joint 4, q4,l2, Fc4 are all known items, so the second inertia parameter mr of joint 4 can be obtained by solving the dynamic equation of joint 4 x4 ,mr y4 .

[0119] In one embodiment of the present application, after identifying the first inertia parameter I of the joint 4 ZZ4 And the second inertia parameter mr of joint 4 x4 ,mr y4 After that, the inertia parameter identification trajectory of joint 2 can be determined based on the dynamic equation of joint 2 in the dynamic model of the minimum inertia parameter set, and then the inertia parameters of joint 2 can be identified based on the inertia parameter identification trajectory of joint 2, such as Figure 7 As shown, step S330 specifically includes steps S710 to S730, which are described in detail as follows:

[0120] Step S710, determining the first inertia parameter identification trajectory of the joint 2 according to the dynamic equation of the joint 2 in the minimum inertia parameter set dynamic model, wherein the first inertia parameter identification trajectory of the joint 2 is the trajectory of the joint 1, the joint 3 and the joint 4 being locked when the joint 2 performs uniformly accelerated motion.

[0121] The inertia parameters of joint 2 include (I ZZ2 +I ZZ3 +2·l2·mr x3 ),(mr x2 +mr x3 ),(mr y2 -mr y3 ), from the dynamic equation of joint 2 in the above formula (3), the first inertia parameter identification trajectory of joint 2 can be determined first, and the first inertia parameter identification trajectory of joint 2 is to identify the inertia parameter (I ZZ2 +I ZZ3 +2·l2·mr x3) and the trajectory designed for the robot, according to the dynamic equation of joint 2 in formula (3), it can be determined that the first inertia parameter identification trajectory of joint 2 is the trajectory that makes joint 2 of the SCARA robot perform uniform acceleration motion, and joints 1, 3 and 4 are all locked.

[0122] Step S720: collecting the current generated by the uniform acceleration motion of the joint 2, and converting the current into the first joint torque of the joint 2.

[0123] Since only joint 2 performs uniform acceleration motion in the first inertia parameter identification trajectory of joint 2, the current generated by the uniform acceleration motion of joint 2 can be collected, and the collected current can be converted into the first joint torque of joint 2 through filtering and other processing.

[0124] Step S730, calculating the first inertia parameter of the joint two according to the first joint torque of the joint two, the first inertia parameter of the joint four and the second inertia parameter of the joint four.

[0125] According to the first inertial parameter identification trajectory of joint 2, when joint 1, joint 3 and joint 4 are all locked, the position vector, velocity vector and acceleration vector of joint 1, joint 3 and joint 4 are all zero. At this time, the dynamic equation of joint 2 can be obtained as follows:

[0126]

[0127] Since the first joint torque of joint 2 is obtained in step S720, that is, τ2 in the dynamic equation of joint 2 is known, and I ZZ4 is the first inertia parameter of joint 4, mr x4 ,mr y4 is the second inertia parameter of joint 4, and the other terms q4, Fc2 are all known items. Therefore, the first inertia parameter of joint 2 (I) can be obtained by solving the dynamic equation of joint 2 according to the first joint torque of joint 2, the first inertia parameter of joint 4 and the second inertia parameter of joint 4. ZZ2 +I ZZ3 +2·l2·mr x3 ).

[0128] In one embodiment of the present application, after the first inertia parameter of the joint 2 is identified, the second inertia parameter identification trajectory of the joint 2 can be determined based on the dynamic equation of the joint 2 in the dynamic model of the minimum inertia parameter set, and then the second inertia parameter identification trajectory of the joint 2 (mr x2 +mr x3 ),(mry2 -mr y3 ),like Figure 8 As shown, step S330 specifically includes steps S810 to S830, which are described in detail as follows:

[0129] Step S810, determining the second inertia parameter identification trajectory of the joint 2 according to the dynamic equation of the joint 2 in the minimum inertia parameter set dynamic model, the second inertia parameter identification trajectory of the joint 2 being the trajectory when the joint 1 and the joint 2 are both moving at a uniform speed and the joint 3 and the joint 4 are both locked.

[0130] In order to identify the second inertia parameter of joint 2 (mr x2 +mr x3 ),(mr y2 -mr y3 ), firstly, the second inertia parameter identification trajectory of joint two can be determined according to the dynamic equation of joint two in the above formula (3). The second inertia parameter identification trajectory is a trajectory designed for the robot to identify the second inertia parameters of joint two. According to the dynamic equation of joint two, the second inertia parameter identification trajectory of joint four can be determined as a trajectory that makes joint one and joint two of the SCARA robot move at a uniform speed and joint three and joint four are locked.

[0131] Step S820: collecting the current generated by the uniform motion of the joint 2, and converting the current into a second joint torque of the joint 2.

[0132] Although both joint one and joint two perform uniform motion in the second inertia parameter identification trajectory of joint two, since only the second inertia parameter identification trajectory of joint two is needed to identify the second inertia parameter of joint two, it is possible to only collect the current generated by the uniform motion of joint two, and convert the collected current into the second joint torque of joint two through filtering and other processing.

[0133] Step S830, calculating the second inertia parameter of the joint two according to the second joint torque of the joint two and the second inertia parameter of the joint four.

[0134] According to the second inertia parameter identification trajectory of joint 2, when joints 3 and 4 are locked, the position vector, velocity vector and acceleration vector of joints 3 and 4 are all zero. At this time, the dynamic equation of joint 2 can be obtained as follows:

[0135]

[0136] Since the second joint torque τ2 of joint 2 is obtained in step S820, that is, τ2 is known in the dynamic equation of joint 2, and mrx4 ,mr y4 is the second inertia parameter of joint 4, and the other terms l1,q2, Fc2 are all known items. Therefore, the dynamic equation of joint 2 can be solved according to the second joint torque of the second joint and the second inertia parameter of joint 4 to obtain the second inertia parameter of joint 2 (mr x2 +mr x3 ),(mr y2 -mr y3 ).

[0137] In one embodiment of the present application, in order to identify the inertia parameters of joint 1, the inertia parameter identification trajectory of joint 1 can be determined based on the dynamic equation of joint 1 in the dynamic model of the minimum inertia parameter set, and then the inertia parameters of joint 1 can be identified based on the inertia parameter identification trajectory of joint 1, such as Fig. 9 As shown, step S330 specifically includes steps S910 to S930, which are described in detail as follows:

[0138] Step S910, determining the inertia parameter identification trajectory of the joint one according to the dynamic equation of the joint one in the minimum inertia parameter set dynamic model, wherein the inertia parameter identification trajectory of the joint one is the trajectory when the joint one performs uniform acceleration motion and the joint two, the joint three and the joint four are all locked.

[0139] As mentioned before, the inertia parameters of joint 1 are From the dynamic equation of joint 1 in the above formula (3), it can be determined that the inertial parameter identification trajectory of joint 1 is a trajectory that makes joint 1 of the SCARA robot perform uniform acceleration motion and joints 2, 3 and 4 are all locked.

[0140] Step S920: collecting the current generated by the uniform acceleration motion of the joint 1, and converting the current into the joint torque of the joint 1.

[0141] Since only joint one performs uniform acceleration motion in the inertial parameter identification trajectory of joint one, the current generated by the uniform acceleration motion of joint one can be collected, and the collected current can be converted into the joint torque of joint one through filtering and other processing.

[0142] Step S930, calculate the inertia parameter of the joint one according to the joint torque of the joint one, the first inertia parameter of the joint four, the second inertia parameter of the joint four, the first inertia parameter of the joint two, and the second inertia parameter of the joint two.

[0143] According to the inertial parameter identification trajectory of joint 1, when joints 2, 3 and 4 are all locked, the position vectors, velocity vectors and acceleration vectors of joints 2, 3 and 4 are all zero. At this time, the dynamic equation of joint 1 can be obtained as follows:

[0144]

[0145] Since the joint torque τ1 of the joint 1 is obtained in step S920, I ZZ4 is the first inertia parameter of joint 4, mr x4 ,mr y4 is the second inertia parameter of joint 4, (I ZZ2 +I ZZ3 +2·l2·mr x3 ) is the first inertia parameter of joint 2, (mr x2 +mr x3 ),(mr y2 -mr y3 ) is the second inertia parameter of joint 2, and the other terms l1, q2,q4, Fc1 are all known items. Therefore, the dynamic equation of joint 1 can be solved according to the joint torque of joint 1, the first inertia parameter of joint 4, the second inertia parameter of joint 4, the first inertia parameter of joint 2 and the second inertia parameter of joint 2 to obtain the inertia parameter of joint 1.

[0146] In one embodiment of the present application, in order to identify the inertia parameters of joint three, the inertia parameter identification trajectory of joint three can be determined based on the dynamic equation of joint three in the dynamic model of the minimum inertia parameter set, and then the inertia parameters of joint three can be identified based on the inertia parameter identification trajectory of joint three, such as Fig.10 As shown, step S330 specifically includes steps S1010 to S1030, which are described in detail as follows:

[0147] Step S1010, determining the inertia parameter identification trajectory of the joint three according to the dynamic equation of the joint three in the minimum inertia parameter set dynamic model, wherein the inertia parameter identification trajectory of the joint three is a trajectory in which the joint one, the joint two and the joint four are all locked when the joint three performs uniformly accelerated motion.

[0148] As mentioned above, the inertia parameter of joint three is m3+m4. From the dynamic equation of joint three in formula (3), it can be determined that the inertia parameter identification trajectory of joint three is a trajectory that makes joint three of the SCARA robot perform uniform acceleration motion and joints one, two and four are all locked.

[0149] Step S1020, collecting the current generated by the uniform motion of the joint three, and converting the current into the joint force of the joint three.

[0150] Since only joint three is performing uniform motion in the inertial parameter identification trajectory of joint three, the current generated by the uniform motion of joint three can be collected, and the collected current can be converted into the joint torque of joint three through filtering and other processing.

[0151] Step S1030: Calculate the inertia parameter of the joint three according to the joint force of the joint three.

[0152] According to the inertial parameter identification trajectory of joint 3, when joint 1, joint 2 and joint 4 are all locked, the position vector, velocity vector and acceleration vector of joint 1, joint 2 and joint 4 are all zero. At this time, the dynamic equation of joint 3 can be obtained as follows:

[0153]

[0154] Since the joint force f3 of joint 3 is obtained in step S1020, the other items g, Fc3 are all known items. Therefore, the dynamic equation of joint three can be solved according to the joint force of joint three to obtain the inertia parameter m3+m4 of joint three.

[0155] Fig.11 FIG. 1 shows an interactive flow chart of a method for identifying the friction coefficient of a SCARA robot according to an embodiment of the present application. Fig.11 As shown, the method for identifying the friction coefficient of the SCARA robot mainly includes the following steps:

[0156] Step S1, select a single joint;

[0157] Step S2: a single joint performs forward and reverse uniform motion, and other joints are locked;

[0158] Step S3, collecting motion data of a single joint performing forward and reverse uniform motion;

[0159] The motion data may include joint torque or joint force. If the single joint is joint three, since joint three is a mobile joint and the motion speed is linear speed, the collected motion data may be the joint force of joint three; if the single joint is any one of joint one, joint two and joint four, since joint one, joint two and joint four are rotational joints and the motion speed is angular velocity, the collected motion data may be the joint torque of the corresponding joint.

[0160] Step S4, fitting a motion straight line graph;

[0161] In step S4, a speed-force diagram or a speed-torque diagram can be fitted according to the collected motion data. If the selected joint is a rotational joint, the following diagram can be fitted: Fig.12 If the selected joint is a moving joint, the velocity-torque diagram shown in Fig.13 Speed-force diagram shown.

[0162] Step S5, solving the viscous friction coefficient and Coulomb friction coefficient of a single joint;

[0163] If the result obtained in step S4 is as follows Fig.12 In the velocity-torque diagram shown, the slopes of straight line A and straight line B are equal, so the slope of the velocity-torque diagram can be used as the viscous friction coefficient of a single joint. The absolute values ​​of the intercepts K and M are equal, and the absolute value of K or M is the Coulomb friction coefficient of a single joint.

[0164] If the result obtained in step S4 is as follows Fig.13 In the velocity-force diagram shown, the slopes of straight line A and straight line B are equal, so the slope of the velocity-force diagram can be used as the viscous friction coefficient of a single joint. The absolute values ​​of the intercepts K and M are not equal, so the average of the sum of the absolute values ​​of K and M can be used as the Coulomb friction coefficient of a single joint.

[0165] Step S6, determine whether it is the last joint of the SCARA robot, if so, proceed to step S7, if not, proceed to step S8;

[0166] Step S7, end;

[0167] Step S8, select the next joint and repeat steps S2 to S6.

[0168] Fig.14 A block diagram of a device for identifying dynamic parameters of a SCARA robot according to an embodiment of the present application is shown, referring to Fig.14 As shown, according to an embodiment of the present application, a device 1400 for identifying the dynamic parameters of a SCARA robot, the SCARA robot includes four joints, joint one, joint two and joint four are rotational joints, and joint three is a movable joint, including: an acquisition unit 1402, a first determination and identification unit 1404 and a second determination and identification unit 1406.

[0169] Among them, the acquisition unit 1402 is configured to acquire the minimum inertia parameter set dynamic model of the SCARA robot with friction terms; the first determination and identification unit 1404 is configured to determine the friction coefficient identification trajectory of each joint according to the minimum inertia parameter set dynamic model, and identify the friction coefficient of each joint based on the friction coefficient identification trajectory; the second determination and identification unit 1406 is configured to determine the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamic model, and identify the inertia parameters of each joint based on the inertia parameter identification trajectory.

[0170] In some embodiments of the present application, the first determination and identification unit 1404 is configured to identify the friction coefficient of each joint as a trajectory in which the other three joints are locked when the joints perform forward and reverse uniform motion. The first determination and identification unit includes: an acquisition subunit, configured to acquire motion data of the joints performing forward and reverse uniform motion; a fitting subunit, configured to obtain a motion straight line graph of the joints according to the acquired motion data; a friction coefficient determination subunit, configured to use the slope of the motion straight line graph as the viscous friction coefficient of each joint, and determine the Coulomb friction coefficient of each joint according to the vertical intercept of the motion straight line graph; a processing subunit, configured to obtain the friction coefficient of each joint according to the viscous friction coefficient of each joint and the Coulomb friction coefficient of each joint.

[0171] In some embodiments of the present application, the friction coefficient determination subunit is configured as follows: if the joint performing forward and reverse uniform motion is any of the rotational joints, the absolute value of any vertical intercept of the motion straight line graph is used as the Coulomb friction coefficient of the rotational joint; if the joint performing forward and reverse uniform motion is the moving joint, the average value of the absolute values ​​of the two vertical intercepts of the motion straight line graph is calculated, and the average value is used as the Coulomb friction coefficient of the moving joint.

[0172] In some embodiments of the present application, the second determination and identification unit 1406 is configured to: determine the first inertia parameter identification trajectory of the joint four according to the dynamic equation of the joint four in the minimum inertia parameter set dynamic model, the first inertia parameter identification trajectory of the joint four being the trajectory when the joint four performs uniform acceleration motion and the joint one, the joint two and the joint three are all locked; collect the current generated by the uniform acceleration motion of the joint four, and convert the current into the first joint torque of the joint four; calculate the first inertia parameter of the joint four according to the first joint torque of the joint four.

[0173] In some embodiments of the present application, the second determination and identification unit 1406 is configured to: determine the second inertia parameter identification trajectory of the joint four according to the dynamic equation of the joint four in the minimum inertia parameter set dynamic model, the second inertia parameter identification trajectory of the joint four being the trajectory when the joint two and the joint four are both moving at a uniform speed and the joint one and the joint three are both locked; collect the current generated by the uniform motion of the joint four, and convert the current into the second joint torque of the joint four; calculate the second inertia parameter of the joint four according to the second joint torque of the joint four.

[0174] In some embodiments of the present application, the second determination and identification unit 1406 is configured to: determine the first inertia parameter identification trajectory of the joint two according to the dynamic equation of the joint two in the minimum inertia parameter set dynamic model, the first inertia parameter identification trajectory of the joint two being the trajectory of the joint one, the joint three and the joint four being locked when the joint two performs uniform acceleration motion; collect the current generated by the uniform acceleration motion of the joint two, and convert the current into the first joint torque of the joint two; calculate the first inertia parameter of the joint two according to the first joint torque of the joint two, the first inertia parameter of the joint four and the second inertia parameter of the joint four.

[0175] In some embodiments of the present application, the second determination and identification unit 1406 is configured to: determine the second inertia parameter identification trajectory of the joint two according to the dynamic equation of the joint two in the minimum inertia parameter set dynamic model, the second inertia parameter identification trajectory of the joint two being the trajectory when the joint one and the joint two are both moving at a uniform speed and the joint three and the joint four are both locked; collect the current generated by the uniform motion of the joint two, and convert the current into the second joint torque of the joint two; calculate the second inertia parameter of the joint two according to the second joint torque of the joint two and the second inertia parameter of the joint four.

[0176] In some embodiments of the present application, the second determination and identification unit 1406 is configured to: determine the inertia parameter identification trajectory of the joint one according to the dynamic equation of the joint one in the minimum inertia parameter set dynamic model, the inertia parameter identification trajectory of the joint one being the trajectory when the joint one performs uniform acceleration motion and the joint two, the joint three and the joint four are all locked; collect the current generated by the uniform acceleration motion of the joint one, and convert the current into the joint torque of the joint one; calculate the inertia parameter of the joint one according to the joint torque of the joint one, the first inertia parameter of the joint four, the second inertia parameter of the joint four, the first inertia parameter of the joint two and the second inertia parameter of the joint two.

[0177] In some embodiments of the present application, the second determination and identification unit 1406 is configured to: determine the inertia parameter identification trajectory of the joint three according to the dynamic equation of the joint three in the minimum inertia parameter set dynamic model, the inertia parameter identification trajectory of the joint three being the trajectory when the joint three performs uniform acceleration motion and the joint one, the joint two and the joint four are all locked; collect the current generated by the uniform motion of the joint three, and convert the current into the joint force of the joint three; calculate the inertia parameters of the joint three according to the joint force of the joint three.

[0178] Fig.15 A schematic diagram of the structure of a computer system suitable for implementing an electronic device of an embodiment of the present application is shown.

[0179] It should be noted that Fig.15 The computer system 1500 of the electronic device shown is only an example and should not bring any limitation to the functions and scope of use of the embodiments of the present application.

[0180] like Fig.15 As shown, the computer system 1500 includes a central processing unit (CPU) 1501, which can perform various appropriate actions and processes according to the program stored in the read-only memory (ROM) 1502 or the program loaded from the storage part 1508 to the random access memory (RAM) 1503, such as executing the method described in the above embodiment. In RAM 1503, various programs and data required for system operation are also stored. CPU 1501, ROM 1502 and RAM 1503 are connected to each other through bus 1504. Input / output (I / O) interface 1505 is also connected to bus 1504.

[0181] The following components are connected to the I / O interface 1505: an input section 1506 including a keyboard, a mouse, etc.; an output section 1507 including a cathode ray tube (CRT), a liquid crystal display (LCD), etc., and a speaker, etc.; a storage section 1508 including a hard disk, etc.; and a communication section 1509 including a network interface card such as a LAN (Local Area Network) card, a modem, etc. The communication section 1509 performs communication processing via a network such as the Internet. A drive 1510 is also connected to the I / O interface 1505 as needed. A removable medium 1511, such as a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, etc., is installed on the drive 1510 as needed so that a computer program read therefrom is installed into the storage section 1508 as needed.

[0182] In particular, according to an embodiment of the present application, the process described above with reference to the flowchart can be implemented as a computer software program. For example, an embodiment of the present application includes a computer program product, which includes a computer program carried on a computer-readable medium, and the computer program includes a computer program for executing the method shown in the flowchart. In such an embodiment, the computer program can be downloaded and installed from a network through a communication section 1509, and / or installed from a removable medium 1511. When the computer program is executed by a central processing unit (CPU) 1501, various functions defined in the system of the present application are executed.

[0183] It should be noted that the computer-readable medium shown in the embodiment of the present application may be a computer-readable signal medium or a computer-readable storage medium or any combination of the above two. The computer-readable storage medium may be, for example, - but not limited to - an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples of computer-readable storage media may include, but are not limited to: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM), a flash memory, an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In the present application, a computer-readable storage medium may be any tangible medium containing or storing a program, which may be used by an instruction execution system, device or device or used in combination with it. In the present application, a computer-readable signal medium may include a data signal propagated in a baseband or as part of a carrier wave, wherein a computer-readable computer program is carried. Such propagated data signals may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. Computer-readable signal media may also be any computer-readable medium other than computer-readable storage media, which may send, propagate, or transmit programs for use by or in conjunction with an instruction execution system, apparatus, or device. The computer program contained on the computer-readable medium may be transmitted using any appropriate medium, including but not limited to: wireless, wired, etc., or any suitable combination of the above.

[0184] The flowchart and block diagram in the accompanying drawings illustrate the possible architecture, functions and operations of the system, method and computer program product according to various embodiments of the present application. Wherein, each box in the flowchart or block diagram can represent a module, a program segment, or a part of the code, and the above-mentioned module, program segment, or a part of the code contains one or more executable instructions for realizing the specified logical function. It should also be noted that in some alternative implementations, the functions marked in the box can also occur in a different order from the order marked in the accompanying drawings. For example, two boxes represented in succession can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each box in the block diagram or flowchart, and the combination of boxes in the block diagram or flowchart can be implemented with a dedicated hardware-based system that performs a specified function or operation, or can be implemented with a combination of dedicated hardware and computer instructions.

[0185] The units involved in the embodiments described in this application may be implemented by software or hardware, and the units described may also be set in a processor. The names of these units do not, in some cases, constitute limitations on the units themselves.

[0186] As another aspect, the present application also provides a computer-readable medium, which may be included in the electronic device described in the above embodiment; or may exist independently without being assembled into the electronic device. The above computer-readable medium carries one or more programs, and when the above one or more programs are executed by an electronic device, the electronic device implements the method described in the above embodiment.

[0187] It should be noted that, although several modules or units of the equipment for action execution are mentioned in the above detailed description, this division is not mandatory. In fact, according to the embodiments of the present application, the features and functions of two or more modules or units described above can be embodied in one module or unit. On the contrary, the features and functions of one module or unit described above can be further divided into being embodied by multiple modules or units.

[0188] Through the description of the above implementation methods, it is easy for those skilled in the art to understand that the example implementation methods described here can be implemented by software or by combining software with necessary hardware. Therefore, the technical solution according to the implementation methods of the present application can be embodied in the form of a software product, which can be stored in a non-volatile storage medium (which can be a CD-ROM, a USB flash drive, a mobile hard disk, etc.) or on a network, and includes several instructions to enable a computing device (which can be a personal computer, a server, a touch terminal, or a network device, etc.) to execute the method according to the implementation methods of the present application.

[0189] Those skilled in the art will readily appreciate other embodiments of the present application after considering the specification and practicing the embodiments disclosed herein. The present application is intended to cover any variations, uses or adaptations of the present application, which follow the general principles of the present application and include common knowledge or customary technical means in the art that are not disclosed in the present application.

[0190] It should be understood that the present application is not limited to the precise structures that have been described above and shown in the drawings, and that various modifications and changes may be made without departing from the scope thereof. The scope of the present application is limited only by the appended claims.

Claims

1. A method for identifying dynamic parameters of a SCARA robot, wherein the SCARA robot comprises four joints, wherein joint 1, joint 2 and joint 4 are rotation joints, and joint 3 is a translation joint. It is characterized in that The method comprises: Obtaining a dynamic model of a minimum inertia parameter set with a friction term for the SCARA robot; Determining a friction coefficient identification trajectory of each joint according to the minimum inertia parameter set dynamics model, and identifying the friction coefficient of each joint based on the friction coefficient identification trajectory; Determining an inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model, and identifying the inertia parameters of each joint based on the inertia parameter identification trajectory; The friction coefficient identification trajectory of each joint is a trajectory when each joint performs forward and reverse uniform motion and the other three joints are locked. The friction coefficient of each joint is identified based on the friction coefficient identification trajectory, including: Collecting motion data of each joint performing forward and reverse uniform motion; According to the collected motion data, a motion straight line diagram of each joint is obtained by fitting, wherein the motion straight line diagram is a velocity-torque relationship diagram; The slope of the motion straight line graph is used as the viscous friction coefficient of each joint, and the Coulomb friction coefficient of each joint is determined according to the vertical intercept of the motion straight line graph; The friction coefficient of each joint is obtained according to the viscous friction coefficient of each joint and the Coulomb friction coefficient of each joint.

2. The method according to claim 1, It is characterized in that Determining the Coulomb friction coefficient of each joint according to the vertical intercept of the motion straight line graph includes: If the joint that performs forward and reverse uniform motion is any of the rotational joints, the absolute value of any vertical intercept of the motion straight line graph is taken as the Coulomb friction coefficient of the rotational joint; If the joint performing forward and reverse uniform motion is the moving joint, the average value of the absolute values ​​of the two vertical intercepts of the motion straight line graph is calculated, and the average value is used as the Coulomb friction coefficient of the moving joint.

3. The method according to claim 1, It is characterized in that Determining the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model includes: According to the dynamic equation of the joint 4 in the minimum inertia parameter set dynamic model, determining the first inertia parameter identification trajectory of the joint 4, wherein the first inertia parameter identification trajectory of the joint 4 is a trajectory in which the joint 1, the joint 2 and the joint 3 are all locked when the joint 4 performs uniform acceleration motion; Based on the inertia parameter identification trajectory, identifying the inertia parameters of each joint includes: collecting the current generated by the uniformly accelerated motion of the joint four, and converting the current into a first joint torque of the joint four; According to the first joint torque of the joint four, the first inertia parameter of the joint four is calculated.

4. The method according to claim 3, It is characterized in that Determining the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model includes: According to the dynamic equation of the joint 4 in the minimum inertia parameter set dynamic model, determining the second inertia parameter identification trajectory of the joint 4, the second inertia parameter identification trajectory of the joint 4 being a trajectory in which the joint 1 and the joint 3 are both locked when the joint 2 and the joint 4 are both moving at a uniform speed; Based on the inertia parameter identification trajectory, identifying the inertia parameters of each joint includes: collecting the current generated by the uniform motion of the joint four, and converting the current into a second joint torque of the joint four; According to the second joint torque of the joint four, the second inertia parameter of the joint four is calculated.

5. The method according to claim 4, It is characterized in that Determining the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model includes: According to the dynamic equation of the joint 2 in the minimum inertia parameter set dynamic model, determining the first inertia parameter identification trajectory of the joint 2, wherein the first inertia parameter identification trajectory of the joint 2 is a trajectory in which the joint 1, the joint 3 and the joint 4 are locked when the joint 2 performs uniform acceleration motion; Based on the inertia parameter identification trajectory, identifying the inertia parameters of each joint includes: collecting the current generated by the uniformly accelerated motion of the joint 2, and converting the current into a first joint torque of the joint 2; The first inertia parameter of the joint two is calculated according to the first joint torque of the joint two, the first inertia parameter of the joint four and the second inertia parameter of the joint four.

6. The method according to claim 5, It is characterized in that Determining the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model includes: According to the dynamic equation of the joint 2 in the minimum inertia parameter set dynamic model, determining the second inertia parameter identification trajectory of the joint 2, wherein the second inertia parameter identification trajectory of the joint 2 is a trajectory in which the joint 3 and the joint 4 are locked when the joint 1 and the joint 2 are both moving at a uniform speed; Based on the inertia parameter identification trajectory, identifying the inertia parameters of each joint includes: collecting the current generated by the uniform motion of the joint 2, and converting the current into a second joint torque of the joint 2; The second inertia parameter of the joint two is calculated according to the second joint torque of the joint two and the second inertia parameter of the joint four.

7. The method according to claim 6, It is characterized in that Determining the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model includes: According to the dynamic equation of the joint 1 in the minimum inertia parameter set dynamic model, determining the inertia parameter identification trajectory of the joint 1, the inertia parameter identification trajectory of the joint 1 being a trajectory in which the joint 2, the joint 3 and the joint 4 are all locked when the joint 1 performs uniform acceleration motion; Based on the inertia parameter identification trajectory, identifying the inertia parameters of each joint includes: collecting the current generated by the uniformly accelerated motion of the joint 1, and converting the current into the joint torque of the joint 1; The inertia parameter of the joint one is calculated according to the joint torque of the joint one, the first inertia parameter of the joint four, the second inertia parameter of the joint four, the first inertia parameter of the joint two, and the second inertia parameter of the joint two.

8. The method according to claim 1, It is characterized in that Determining the inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model includes: According to the dynamic equation of the joint three in the minimum inertia parameter set dynamic model, determining the inertia parameter identification trajectory of the joint three, the inertia parameter identification trajectory of the joint three being the trajectory in which the joint one, the joint two and the joint four are all locked when the joint three performs uniform acceleration motion; Based on the inertia parameter identification trajectory, identifying the inertia parameters of each joint includes: collecting the current generated by the uniform motion of the joint three, and converting the current into the joint force of the joint three; According to the joint force of the joint three, the inertia parameter of the joint three is calculated.

9. A device for identifying dynamic parameters of a SCARA robot, wherein the SCARA robot comprises four joints, wherein joint 1, joint 2 and joint 4 are rotation joints, and joint 3 is a translation joint. It is characterized in that The device comprises: An acquisition unit configured to acquire a minimum inertia parameter set dynamic model of the SCARA robot with a friction term; A first determination and identification unit is configured to determine a friction coefficient identification trajectory of each joint according to the minimum inertia parameter set dynamics model, and identify the friction coefficient of each joint based on the friction coefficient identification trajectory; a second determination and identification unit, configured to determine an inertia parameter identification trajectory of each joint according to the minimum inertia parameter set dynamics model, and identify the inertia parameters of each joint based on the inertia parameter identification trajectory; The friction coefficient identification trajectory of each joint is a trajectory of the other three joints being locked when each joint performs forward and reverse uniform motion. The first determination and identification unit identifies the friction coefficient of each joint based on the friction coefficient identification trajectory, including: Collecting motion data of each joint performing forward and reverse uniform motion; According to the collected motion data, a motion straight line diagram of each joint is obtained by fitting, wherein the motion straight line diagram is a velocity-torque relationship diagram; The slope of the motion straight line graph is used as the viscous friction coefficient of each joint, and the Coulomb friction coefficient of each joint is determined according to the vertical intercept of the motion straight line graph; The friction coefficient of each joint is obtained according to the viscous friction coefficient of each joint and the Coulomb friction coefficient of each joint.