Load parameter determination, verification and comparison method and device, medium and robot

By measuring and measuring the weight, center of mass coordinates and inertia matrix of the load of the computer robot, the problem of inaccurate load parameter determination in the prior art is solved, the robot control accuracy and performance are improved, and the risk of downtime is reduced.

CN119017386APending Publication Date: 2024-11-26KUKA ROBOTICS GUANGDONG CO LTD
View PDF 11 Cites 0 Cited by

Patent Information

Application Number
CN202411227252.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-02
Publication Date
2024-11-26

AI Technical Summary

Technical Problem

The prior art is difficult to accurately determine the robot load parameters, resulting in a degradation of control accuracy and motion performance, and incorrect load parameters may trigger the robot safety mechanism and lead to downtime.

Method used

By measuring the weight, center of mass coordinates and moment of inertia matrix of load, load parameters are calculated using distance measurement values ​​and geometric dimension information, providing determination, checksum comparison methods to ensure the accuracy of generated load parameters.

Benefits of technology

Improves robot control accuracy and motion performance, reduces the deviation between instructions and actual data, and reduces the risk of downtime caused by triggering safety mechanisms.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119017386A_ABST
    Figure CN119017386A_ABST
Patent Text Reader

Abstract

The invention provides a load parameter determination, verification and comparison method and device, a medium and a robot, the load parameter determination method comprises the following steps: obtaining measurement data obtained by measuring a load, the measurement data comprises a distance measurement value and a weight measurement value of the load, and the distance measurement value is obtained by measuring the weight of the load after the load is assembled on a flange; the distance value between the geometric center of the load and the center of the flange; determining geometric dimension information of the load; load parameters are determined based on weight measurements, distance measurements, and geometric dimension information of the load. In the process, the measurement data used for generating the load parameter is obtained by measuring the load, so that the generated load parameter has higher accuracy.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of control technology, and in particular to a method, device, medium and robot for determining, verifying and comparing load parameters. Background Art

[0002] The load parameters of the robot include the load weight value, the load center of mass coordinates and the load inertia matrix. For the robot, accurate load parameters help the robot to more accurately calculate the feedforward torque of each axis to improve the robot's control accuracy and motion performance. In addition, the load parameters will also directly affect the robot's motion planning, such as affecting the operating speed of the industrial robot, the torque of each axis and the service life of the components.

[0003] At the same time, incorrect load parameters may cause a large deviation between the robot instructions and the actual data, thereby triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0004] Obviously, how to obtain accurate load parameters is an urgent problem to be solved at this stage. Summary of the invention

[0005] The present invention aims to at least solve the problem of how to obtain accurate load parameters existing in the prior art or related art.

[0006] To this end, a first aspect of the present invention is to provide a method for determining a load parameter.

[0007] A second aspect of the present invention is to provide a method for verifying load parameters.

[0008] The third aspect of the present invention is to provide a load parameter comparison method.

[0009] A fourth aspect of the present invention is to provide a device for determining load parameters.

[0010] A fifth aspect of the present invention is to provide a load parameter verification device.

[0011] A sixth aspect of the present invention is to provide a load parameter comparison device.

[0012] A seventh aspect of the present invention is to provide another device for determining load parameters.

[0013] An eighth aspect of the present invention is to provide another device for verifying load parameters.

[0014] A ninth aspect of the present invention is to provide another load parameter comparison device.

[0015] A tenth aspect of the present invention provides a readable storage medium.

[0016] An eleventh aspect of the present invention provides a robot.

[0017] In view of this, according to a first aspect of the present invention, the present invention provides a method for determining load parameters, comprising: obtaining measurement data obtained by measuring the load, the measurement data including a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; determining the geometric dimension information of the load; and determining the load parameters based on the weight measurement value, the distance measurement value and the geometric dimension information of the load.

[0018] The present invention proposes a method for determining a load parameter, which generates a load parameter based on the measurement data after obtaining or receiving the measurement data obtained after measuring the load by running the load parameter determination method. In this process, the measurement data used to generate the load parameter is obtained by measuring the load, so that the generated load parameter has a higher accuracy.

[0019] In the above technical solution, the flange has a mounting surface for assembling the load, and the flange center can be understood as the center position of the mounting surface.

[0020] In the above technical solution, the geometric center of the load can be understood as the physical center of the load in the xyz coordinate system.

[0021] For example, in the xyz coordinate system, the length of the load in the x-axis direction is x1, the length in the y-axis direction is y1, and the length in the z-axis direction is z1. The coordinates of the physical center are (x1 / 2, y1 / 2, z1 / 2). When the flange center is the origin, the distance measurement values ​​are x1, y1 and z1.

[0022] In the above technical solution, the weight measurement value can be measured by a weight measuring device, such as by weighing the weight of the load using an electronic scale, or can be read from the nameplate of the load.

[0023] In the above technical solution, the geometric dimension information can be understood as the external dimensions of the load. By obtaining the geometric dimension information, the geometric dimension information can be used to describe the shape of the load, and then in the process of determining the load parameters, the load inertia matrix in the load parameters can be accurately described. In this process, the measurement data is the measurable parameters of the load, and the parameters that are difficult to directly measure can be calculated by mathematical methods to ensure the accuracy of the generated load parameters.

[0024] In addition, the method for determining load parameters proposed in this application also has the following additional technical features.

[0025] In some technical schemes, optionally, the load parameters include: load weight value, load center of mass coordinates and load inertia matrix. The load parameters are determined based on the load weight measurement value, distance measurement value and geometric dimension information, specifically including: using the load weight measurement value as the load weight value; determining the load inertia matrix based on the load weight measurement value and geometric dimension information; determining the load center of mass coordinates based on the distance measurement value.

[0026] In this technical solution, since the weight measurement value is obtained by measuring the load, it can accurately describe the weight of the load, so the weight measurement value can be directly used as the load weight value. Similarly, the distance measurement value can directly describe the shape of the load, and the load center of mass has a direct relationship with the load shape, so the load center of mass coordinates can be directly determined based on the distance measurement value.

[0027] The load inertia matrix is ​​related to the weight and geometric dimensions of the load, so the load inertia matrix can be constructed using the weight measurement value and geometric dimension information. In this process, the load weight value, load inertia matrix and load center of mass coordinates involved in the load parameters can all be calculated using the known measurement data and geometric dimension information. Therefore, the load parameters can be automatically generated.

[0028] Compared with the case where the load parameters are given directly, the load parameters calculated by the present application through measurement data and geometric dimension information are more accurate. When the robot works using the generated load parameters, the control accuracy and motion performance of the robot can be ensured.

[0029] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0030] In some technical solutions, optionally, for a general rigid body, the load inertia matrix is ​​expressed as:

[0031]

[0032] I xy =I yx =∫ m x'y'dm;I xz =I zx =∫ m x'z'dm;I yz =I zy =∫ m y'z'dm;I xx =∫ m (y' 2 +z' 2 )dm;I yy =∫ m(x' 2 +z' 2 )dm;I zz =∫ m (x' 2 +y' 2 )dm.

[0033] Among them, I xy ,I yx ,I xz ,I zx ,I yz and I zy are the elements of the non-central principal inertia matrix in the load inertia matrix, x', y', z' are the coordinate values ​​of dm on the x-axis, y-axis and z-axis respectively, ∫ m dm represents the integral of mass, I xx ,I yy ,I zz are the elements of the central principal inertia matrix.

[0034] Specifically, if the coordinate origin of the load inertia matrix is ​​the center of mass, then the coordinate axis is the principal axis of inertia. In this case, I xy =I xz =I yz =0, the load inertia matrix becomes:

[0035]

[0036] in, O I m It is called the central principal inertia matrix.

[0037] For a general inertia matrix, the central principal inertia matrix can be obtained by coordinate transformation, and then the general inertia matrix can be obtained by shifting the center and rotating the axis. Specifically, using the inertia matrix represented by the center of mass and principal axis coordinate system, any general inertia matrix can be obtained by shifting the center and rotating the axis.

[0038] From the coordinate system O xy The central principal inertia matrix under O I m Transform to coordinate system A xyz The general inertia matrix under A I m The mathematical expression of is as follows:

[0039] A I m =A TO I m A

[0040] Among them, A is the coordinate transformation matrix, which represents the transformation from coordinate system O xyz Transform to coordinate system Axy The mathematical relationship of A T is the transpose of A, A I m is the coordinate system A xyz The general inertia matrix under .

[0041] In some technical solutions, optionally, determining the geometric size information of the load specifically includes: receiving geometric shape information of the load, the geometric shape information of the load is used to represent the geometric shape of the load; displaying a first interface based on the geometric shape information of the load, the first interface is used to enter the material density of the load or the geometric size information of the load; receiving the geometric size information of the load based on the first interface; or receiving the material density of the load based on the first interface, and determining the geometric size information of the load based on the material density of the load and the weight measurement value of the load.

[0042] In this technical solution, the shape of the load will be different when the robot is in different usage scenarios. In the technical solution of this application, the user can input geometric shape information according to the actual shape of the load, and then select the first interface that matches the load, and use the first interface to input geometric size information. In this process, the accuracy of the geometric size information of the load can be ensured.

[0043] In the above technical solution, for different loads, the information that the user can know is different. For example, for some loads, the user knows their material density, while for some loads, the user knows the geometric dimension information. Obviously, when the user does not know the geometric dimension information, the geometric dimension information can be indirectly calculated by inputting the material density. In this process, the user can choose to input the material density or directly input the geometric dimension information according to the actual usage scenario. While obtaining the geometric dimension information, it can also meet the needs of different usage scenarios.

[0044] In some technical solutions, the first interface is an interface that corresponds one-to-one to the geometric information.

[0045] In this process, the first interface can be used to display an interface that only matches the geometric shape of the load, thereby reducing the display of other irrelevant information, thereby reducing the probability of mis-input or erroneous input of information.

[0046] For a certain load, after the weight measurement value, external dimensions such as distance measurement value, geometric dimension information or density of the load are known, other unknown physical quantities can be calculated through formulas.

[0047] Specifically, for a cuboid, after knowing the geometric size information, the following information can be calculated:

[0048] V 长 =a1×b1×c1

[0049] m=ρ×V 长

[0050]

[0051] Among them, V 长 is the volume of the cuboid, m is the mass of the cuboid, a1, b1, c1 are the length, width and height of the cuboid, F I m is the load inertia matrix in coordinate system F, and ρ is the material density.

[0052] In industrial robots, the load inertia matrix set in the program needs to be converted according to the parameter definitions of different manufacturers. It can be a load inertia matrix based on the center of mass aligned flange coordinate system, or it can be a load inertia matrix directly based on the flange coordinate system. The difference in the load inertia matrices in different coordinate systems is mainly reflected in the transformation matrix A.

[0053] Specifically, for a sphere, after the geometric size information is known, the following information can be calculated:

[0054]

[0055] Among them, V 球 is the volume of the sphere, π is the circumference of the sphere, and R is the radius of the sphere.

[0056] Specifically, for a cylinder, after knowing the geometric size information, the following information can be calculated:

[0057] V 柱 =πr 2 h

[0058] Among them, V 柱 is the volume of the cylinder, π is the circumference of a circle, r is the radius of the base of the cylinder, and h is the height of the cylinder.

[0059] In the above technical solution, only a simple measurement of the load is required to obtain the complete data required for calculating the load parameters.

[0060] In some technical schemes, optionally, when the geometric shape of the load is a rectangular parallelepiped, the geometric dimension information includes the length, width and height of the rectangular parallelepiped; when the geometric shape of the load is a sphere, the geometric dimension information includes the radius value of the sphere; when the geometric shape of the load is an ellipsoid, the geometric dimension information includes the equatorial radius value and the polar radius value; when the geometric shape of the load is a cylinder, the geometric dimension information includes the base radius value and the height of the cylinder.

[0061] From the above, we can see that for a rigid body, the principal inertia matrix based on the center of mass O isO I m for:

[0062]

[0063] Then for a cuboid, the principal inertia matrix is O I m for:

[0064]

[0065] Among them, m is the weight measurement value of the load, a1, b1 and c1 are geometric size information, and a1, b1 and c1 are the length, width and height of the cuboid respectively.

[0066] For a sphere, the principal moment of inertia matrix O I m for:

[0067]

[0068] Where m is the weight measurement of the load and R is the geometric size information.

[0069] For an ellipsoid, the principal moment of inertia matrix O I m for:

[0070]

[0071] Among them, m is the weight measurement value of the load, a2, b2 and c2 are geometric size information, a2, b2 are the equatorial radius values, and c2 is the polar radius value.

[0072] For a cylinder, the principal moment of inertia matrix O I m for:

[0073]

[0074] Among them, m is the weight measurement of the load, r and h are geometric size information, r is the base radius of the cylinder, and h is the height of the cylinder.

[0075] In this application, only a few common load geometric shapes such as spheres, cuboids and cylinders are listed, but this method is also applicable to other basic geometric shapes, such as: rings, hollow balls, hollow cuboids, hollow spheres, prisms, hexahedrons, etc., only the mathematical formulas need to be expanded, which will not be repeated here.

[0076] According to a second aspect of the present invention, the present invention provides a method for verifying a load parameter, comprising: upon receiving a set load parameter, obtaining a first load parameter, the first load parameter being a load parameter determined based on first measurement data, the first measurement data being measurement data obtained by measuring the load; based on a verification result of the first load parameter and the set load parameter, outputting the set load parameter.

[0077] In this technical solution, since the first load parameter is a load parameter determined based on the first measurement data, the first load parameter can accurately express the actual situation of the load. In the process of using the first load parameter to verify the set load parameter, when the set load parameter is abnormal, the abnormal set load parameter can be verified.

[0078] In this process, the set load parameters are the load parameters used when the robot is running. If there is an abnormality in the set load parameters, the robot operation will become abnormal. By verifying the set load parameters, the impact of abnormal load parameters on the robot operation can be reduced, thereby ensuring the stable operation of the robot.

[0079] In the above technical solution, receiving the set load parameter can be used as a condition for obtaining the first load parameter, thereby realizing automatic acquisition of the first load parameter. At this time, automatic verification of the set load parameter can be realized without user participation.

[0080] In the above technical solution, the load parameters, that is, the load parameters given by the user, can be set, which can be input through the robot's operating interface, or can be input using a terminal or server that interacts with the robot. The specific form will not be repeated here.

[0081] In some technical solutions, the set load parameters may be the default load parameters of the robot, or the load parameters used when the robot last ran.

[0082] In addition, the load parameter verification method proposed in this application also has the following additional technical features.

[0083] In some technical schemes, optionally, setting the load parameters includes setting the weight value, setting the center of mass coordinates and setting the inertia matrix, the first load parameters include the load weight value, the load center of mass coordinates and the load inertia matrix, and based on the verification results of the first load parameters and the set load parameters, the set load parameters are output, specifically including: determining the weight difference between the set weight value and the load weight value, determining the coordinate deviation between the set center of mass coordinates and the load center of mass coordinates, and determining the matrix deviation between the set inertia matrix and the load inertia matrix; based on the weight difference, coordinate deviation and matrix deviation being less than or equal to the corresponding thresholds, the set load parameters are output.

[0084] In this technical solution, the set load parameters are the same as the first load parameters. The difference is that the set load parameters are the load parameters given by the user or used by the robot by default. Therefore, the set load parameters and the first load parameters both contain three parts, namely, the load weight value, the load center of mass coordinates and the load inertia matrix. In order to distinguish, the load weight value in the set load parameters is expressed as the set weight value, the load center of mass coordinates in the set load parameters are expressed as the set center of mass coordinates, and the load inertia matrix in the set load parameters is expressed as the set inertia matrix.

[0085] Based on this, the verification between the first load parameter and the set load parameter mainly includes three parts, namely: verification of the set weight value, verification of the set center of mass coordinates and verification of the set inertia matrix, and the set load parameter is output only when the verification of the three parts passes.

[0086] Specifically, by calculating the weight difference, coordinate deviation and matrix deviation, and when the weight difference, coordinate deviation and matrix deviation are respectively within corresponding thresholds, the set load parameters are output.

[0087] Obviously, in this process, it can be ensured that the set load parameter is almost consistent with the first load parameter, thereby ensuring the accuracy of the set load parameter.

[0088] When the robot works with set load parameters, the control accuracy and motion performance of the robot can be ensured.

[0089] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0090] In the above technical solution, corresponding thresholds are used to compare the set weight value, the set center of mass coordinates and the set inertia matrix respectively, so as to ensure the accuracy of the verification.

[0091] Specifically, the threshold includes a first threshold, a second threshold and a third threshold, wherein the first threshold is the product of the set weight value and a first preset percentage, the second threshold is the product of the set center of mass coordinates and a second preset percentage, and the third threshold is the product of the first value and the third preset percentage, wherein the first value is related to the set inertia matrix.

[0092] Based on the weight difference, coordinate deviation and matrix deviation being less than or equal to the corresponding thresholds, the set load parameters are output, specifically including: based on the weight difference being less than or equal to the first threshold, the coordinate deviation being less than or equal to the second threshold, and each element in the matrix deviation being less than or equal to the third threshold, the set load parameters are output.

[0093] In some technical solutions, optionally, the first preset percentage, the second preset percentage and the third preset percentage are different percentages or the same percentages.

[0094] Exemplarily, the first preset percentage, the second preset percentage and the third preset percentage are 5%.

[0095] In some technical solutions, optionally, based on the weight difference being greater than a threshold corresponding to the weight difference, a first reminder message is output; based on the coordinate deviation being greater than a threshold corresponding to the coordinate deviation, a second reminder message is output; based on the matrix deviation being greater than a threshold corresponding to the matrix deviation, a third reminder message is output; wherein the first reminder message is used to remind the user to update the set weight value, the second reminder message is used to remind the user to update the set center of mass coordinates, and the third reminder message is used to remind the user to update the set inertia matrix.

[0096] In this technical solution, by outputting the first reminder information, the second reminder information and the third reminder information, the user can update the set load parameters according to the first reminder information, the second reminder information and the third reminder information, so that the updated set load parameters and the first load parameters meet the verification conditions, and finally output accurate load parameters to the robot.

[0097] In the above technical solution, the first reminder information, the second reminder information and the third reminder information can be output in the form of text. In this process, the user can modify the set load parameters by viewing the text, thereby improving the efficiency of modifying the set load parameters.

[0098] Specifically, if at least one element in the matrix deviation is greater than a third threshold, a third reminder message is output.

[0099] In some technical solutions, optionally, obtaining the first load parameter specifically includes: obtaining first measurement data, the first measurement data including a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; determining the geometric dimension information of the load; determining the first load parameter based on the weight measurement value, the distance measurement value and the geometric dimension information of the load.

[0100] In this technical solution, after obtaining or receiving the first measurement data obtained after the load measurement, the load parameters are generated based on the first measurement data. In this process, the first measurement data used to generate the load parameters is obtained by the load measurement, which can make the generated first load parameters have higher accuracy.

[0101] In the above technical solution, the flange has a mounting surface for assembling the load, and the flange center can be understood as the center position of the mounting surface.

[0102] In the above technical solution, the geometric center of the load can be understood as the physical center of the load in the xyz coordinate system.

[0103] For example, in the xyz coordinate system, the length of the load in the x-axis direction is x1, the length in the y-axis direction is y1, and the length in the z-axis direction is z1. The coordinates of the physical center are (x1 / 2, y1 / 2, z1 / 2). When the flange center is the origin, the distance measurement values ​​are x1, y1 and z1.

[0104] In the above technical solution, the weight measurement value can be measured by a weight measuring device, such as by weighing the weight of the load using an electronic scale, or can be read from the nameplate of the load.

[0105] In the above technical solution, the geometric dimension information can be understood as the outer dimensions of the load. By obtaining the geometric dimension information, the geometric dimension information can be used to describe the shape of the load, and then in the process of determining the first load parameter, the load inertia matrix in the first load parameter can be accurately described. In this process, the first measurement data is a measurable parameter of the load, and the parameters that are difficult to directly measure can be calculated by mathematical methods to ensure the accuracy of the generated first load parameter.

[0106] According to the third aspect of the present invention, the present invention provides a load parameter comparison method, including: obtaining measurement data obtained by measuring the load and obtaining set load parameters; determining a first graph based on the measurement data, the first graph is a graph represented by a first load graphically, and the first load is the load represented by the measurement data; determining a second graph based on the measurement data and the set load parameters; and displaying the first graph and the second graph.

[0107] In this technical solution, the measurement data is the data obtained by measuring the load, so it can accurately express the actual state of the load. Therefore, the first graph determined based on the measurement data of the load can express the actual state of the load, and the set load parameters are the load parameters set by the user. After graphing them, a second graph can be obtained. The second graph is used to describe the load represented by the set load parameters. By displaying the first graph and the second graph, the user can compare and view the first graph and the second graph, and then determine whether the set load parameters are correct.

[0108] In this process, the input information is converted into geometric figures, and the load data can be matched one-to-one with the actual load geometric dimensions. The load information is displayed intuitively, which can help users check for load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0109] The above detection only requires a simple measurement of the load, and relatively accurate load information can be obtained through mathematical calculations. It does not require modeling or special hardware support, is simple and convenient, and does not need to be bound to a specific robot. The acquired data is highly universal, and is convenient for on-site debugging and rapid deployment.

[0110] In addition, the load parameter comparison method proposed in this application also has the following additional technical features.

[0111] In some technical solutions, optionally, the measurement data includes a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; determining the first figure based on the measurement data specifically includes: obtaining geometric dimension information of the load; determining the first figure based on the weight measurement value and the geometric dimension information; wherein the geometric center of the first figure is determined based on the distance measurement value.

[0112] In this technical solution, the distance measurement value can accurately reflect the center of mass coordinates of the load, the geometric dimension information of the load can accurately reflect the shape of the load, and the weight measurement value can reflect the weight of the load. The weight measurement value and the geometric dimension information are used to determine the load inertia matrix in the load parameters. Therefore, it can be understood that the first figure is a graphical representation of the load inertia matrix, and the geometric center of the first figure is determined based on the distance measurement value. Therefore, the displayed first figure can realize the visualization of the load, and the user can intuitively view the shape of the load through the first figure; similarly, the second figure can be used to intuitively display the load described by the set load parameters. In the process of comparing the first figure and the second figure, it can be accurately known whether the load described by the set load parameters is the same as the load described by the measured data, thereby realizing the inspection of load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0113] In some technical solutions, optionally, the measurement data includes a distance measurement value and a weight measurement value of the load, the distance measurement value is the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange, setting the load parameters includes setting the center of mass coordinates and setting the inertia matrix, and determining the second figure based on the measurement data and the set load parameters specifically includes: obtaining the geometric dimension information of the load; determining the load inertia matrix based on the weight measurement value, distance measurement value and geometric dimension information of the load; determining the transformation parameters based on the set inertia matrix and the load inertia matrix; transforming the first point cloud based on the transformation parameters to obtain a second point cloud, the first point cloud being point cloud data determined based on the measurement data; translating the second point cloud until the geometric center coordinates of the second point cloud after translation are the set center of mass coordinates; and drawing the second figure based on the translated second point cloud.

[0114] In this technical solution, since the weight measurement value and distance measurement value of the load are measured data, they are accurate data. Similarly, the geometric dimension information of the load is also data measured by the user, which is also accurate data. Obviously, the load inertia matrix determined based on the weight measurement value, distance measurement value and geometric dimension information of the load is also accurate.

[0115] The transformation parameters are calculated using the set inertia matrix and the calculated load inertia matrix, so that the transformation parameters can be used to change the shape of the point cloud data determined based on the measurement data. In this process, the first point cloud can be resized and rotated to obtain a second point cloud displayed based on the origin. In this process, the second point cloud is the point cloud affected by the transformation parameters, and the transformation parameters are determined based on the set inertia matrix. Therefore, the second point cloud can intuitively represent the shape of the load.

[0116] From the above, it can be seen that the second point cloud is displayed based on the origin, and the graphics corresponding to the set load parameters should be displayed based on the set center of mass coordinates. Therefore, after determining the second point cloud, the second point cloud is translated until the geometric center coordinates of the second point cloud after translation are the set center of mass coordinates. At this time, the translated second point cloud can accurately represent the load described by the set load parameters. Therefore, the second graphic is drawn based on the translated second point cloud so that the second graphic can be used to represent the load described by the set load parameters.

[0117] In this process, the second figure is transformed based on the point cloud. Therefore, it can accurately describe the load described by the set load parameters. In the process of comparing the first figure and the second figure, it can be accurately known whether the load described by the set load parameters is the same as the load described by the measured data, thereby realizing the inspection of load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0118] In some technical solutions, optionally, the transformation parameters are determined based on the set inertia matrix and the load inertia matrix, specifically including: diagonalizing the set inertia matrix to obtain a first matrix; determining the transformation parameters based on the first matrix and the load inertia matrix; wherein the transformation parameters include scaling factors and rotation matrices.

[0119] In this technical solution, the scaling factors include xs, ys and zs, where xs, ys and zs are respectively related to the corresponding I xx ,I yy ,I zz The three elements are related, and the rotation matrix is ​​the principal axis rotation matrix of inertia.

[0120] In some technical solutions, optionally, the scaling coefficient and the rotation matrix are obtained by singular value decomposition (SVD), or by transformation using other mathematical methods, and the specific decomposition and transformation are not described in detail here.

[0121] In some technical solutions, optionally, the comparison method also includes: determining a deviation value between the first graphic and the second graphic; and outputting the set load parameters and the weight measurement value in the measurement data based on the deviation value being less than or equal to a deviation threshold.

[0122] In this technical solution, the deviation value between the first graph and the second graph is calculated so that the deviation value of the first graph and the second graph can be used to represent the difference between the load represented by the measurement data and the load represented by the set load parameters, and then the deviation threshold is used to measure the difference between the load represented by the measurement data and the load represented by the set load parameters. When the difference is small, that is, when the deviation value is less than or equal to the deviation threshold, the set load parameters and the weight measurement value in the measurement data are output.

[0123] In this process, the output data can accurately represent the load conditions, and when the robot works using the generated load parameters, the control accuracy and motion performance of the robot can be ensured.

[0124] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0125] According to a fourth aspect of the present invention, the present invention provides a device for determining load parameters, comprising: a first acquisition unit, used to acquire measurement data obtained by measuring the load, the measurement data including a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; a first determination unit, used to determine the geometric dimension information of the load; and a second determination unit, used to determine the load parameters based on the weight measurement value, the distance measurement value and the geometric dimension information of the load.

[0126] The present invention proposes a load parameter determination device, which generates load parameters based on the measurement data after acquiring or receiving the measurement data obtained after load measurement. In this process, the measurement data used to generate the load parameters is obtained by the load measurement, so that the generated load parameters have higher accuracy.

[0127] In the above technical solution, the flange has a mounting surface for assembling the load, and the flange center can be understood as the center position of the mounting surface.

[0128] In the above technical solution, the geometric center of the load can be understood as the physical center of the load in the xyz coordinate system.

[0129] For example, in the xyz coordinate system, the length of the load in the x-axis direction is x1, the length in the y-axis direction is y1, and the length in the z-axis direction is z1. The coordinates of the physical center are (x1 / 2, y1 / 2, z1 / 2). When the flange center is the origin, the distance measurement values ​​are x1, y1 and z1.

[0130] In the above technical solution, the weight measurement value can be measured by a weight measuring device, such as by weighing the weight of the load using an electronic scale, or can be read from the nameplate of the load.

[0131] In the above technical solution, the geometric dimension information can be understood as the external dimensions of the load. By obtaining the geometric dimension information, the geometric dimension information can be used to describe the shape of the load, and then in the process of determining the load parameters, the load inertia matrix in the load parameters can be accurately described. In this process, the measurement data is the measurable parameters of the load, and the parameters that are difficult to directly measure can be calculated by mathematical methods to ensure the accuracy of the generated load parameters.

[0132] In addition, the load parameter determination device proposed in this application also has the following additional technical features.

[0133] In some technical schemes, optionally, the load parameters include: load weight value, load center of mass coordinates and load inertia matrix, and the second determination unit is specifically used to: use the load weight measurement value as the load weight value; determine the load inertia matrix based on the load weight measurement value and geometric dimension information; determine the load center of mass coordinates based on the distance measurement value.

[0134] In this technical solution, since the weight measurement value is obtained by measuring the load, it can accurately describe the weight of the load, so the weight measurement value can be directly used as the load weight value. Similarly, the distance measurement value can directly describe the shape of the load, and the load center of mass has a direct relationship with the load shape, so the load center of mass coordinates can be directly determined based on the distance measurement value.

[0135] The load inertia matrix is ​​related to the weight and geometric dimensions of the load, so the load inertia matrix can be constructed using the weight measurement value and geometric dimension information. In this process, the load weight value, load inertia matrix and load center of mass coordinates involved in the load parameters can all be calculated using the known measurement data and geometric dimension information. Therefore, the load parameters can be automatically generated.

[0136] Compared with the case where the load parameters are given directly, the load parameters calculated by the present application through measurement data and geometric dimension information are more accurate. When the robot works using the generated load parameters, the control accuracy and motion performance of the robot can be ensured.

[0137] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0138] In some technical solutions, optionally, for a general rigid body, the load inertia matrix is ​​expressed as:

[0139]

[0140] I xy =I yx =∫ m x'y'dm;I xz =I zx =∫ m x'z'dm;I yz =I zy =∫ m y'z'dm;I xx =∫ m (y' 2 +z' 2 )dm;I yy =∫ m (x' 2 +z' 2 )dm;I zz =∫ m (x' 2 +y' 2 )dm.

[0141] Among them, I xy ,I yx ,I xz ,I zx ,I yz and I zy are the elements of the non-central principal inertia matrix in the load inertia matrix, x', y', z' are the coordinate values ​​of dm on the x-axis, y-axis and z-axis respectively, ∫ m dm represents the integral of mass, I xx ,I yy ,I zz are the elements of the central principal inertia matrix.

[0142] Specifically, if the coordinate origin of the load inertia matrix is ​​the center of mass, then the coordinate axis is the principal axis of inertia. In this case, I xy =I xz =I yz =0, the load inertia matrix becomes:

[0143]

[0144] in, O I m It is called the central principal inertia matrix.

[0145] For a general inertia matrix, the central principal inertia matrix can be obtained by coordinate transformation, and then the general inertia matrix can be obtained by shifting the center and rotating the axis. Specifically, using the inertia matrix represented by the center of mass and principal axis coordinate system, any general inertia matrix can be obtained by shifting the center and rotating the axis.

[0146] From the coordinate system O xy The central principal inertia matrix under O I m Transform to coordinate system A xyz The general inertia matrix under A I m The mathematical expression of is as follows:

[0147] A I m =A TO I m A

[0148] Among them, A is the coordinate transformation matrix, which represents the transformation from coordinate system O xyz Transform to coordinate system A xyz The mathematical relationship of A T is the transpose of A, A I m is the coordinate system A xyz The general inertia matrix under .

[0149] In some technical schemes, optionally, the first determination unit is specifically used to: receive geometric morphological information of the load, the geometric morphological information of the load is used to represent the geometric shape of the load; display a first interface based on the geometric morphological information of the load, the first interface is used to enter the material density of the load or the geometric dimension information of the load; receive the geometric dimension information of the load based on the first interface; or receive the material density of the load based on the first interface, and determine the geometric dimension information of the load based on the material density of the load and the weight measurement value of the load.

[0150] In this technical solution, the shape of the load will be different when the robot is in different usage scenarios. In the technical solution of this application, the user can input geometric shape information according to the actual shape of the load, and then select the first interface that matches the load, and use the first interface to input geometric size information. In this process, the accuracy of the geometric size information of the load can be ensured.

[0151] In the above technical solution, for different loads, the information that the user can know is different. For example, for some loads, the user knows their material density, while for some loads, the user knows the geometric dimension information. Obviously, when the user does not know the geometric dimension information, the geometric dimension information can be indirectly calculated by inputting the material density. In this process, the user can choose to input the material density or directly input the geometric dimension information according to the actual usage scenario. While obtaining the geometric dimension information, it can also meet the needs of different usage scenarios.

[0152] In some technical solutions, the first interface is an interface that corresponds one-to-one to the geometric information.

[0153] In this process, the first interface can be used to display an interface that only matches the geometric shape of the load, thereby reducing the display of other irrelevant information, thereby reducing the probability of mis-input or erroneous input of information.

[0154] For a certain load, after the weight measurement value, external dimensions such as distance measurement value, geometric dimension information or density of the load are known, other unknown physical quantities can be calculated through formulas.

[0155] Specifically, for a cuboid, after knowing the geometric size information, the following information can be calculated:

[0156] V 长 =a1×b1×c1

[0157] m=ρ×V 长

[0158]

[0159] Among them, V 长 is the volume of the cuboid, m is the mass of the cuboid, a1, b1, c1 are the length, width and height of the cuboid, F I m is the load inertia matrix in coordinate system F.

[0160] In industrial robots, the load inertia matrix set in the program needs to be converted according to the parameter definitions of different manufacturers. It can be a load inertia matrix based on the center of mass aligned flange coordinate system, or it can be a load inertia matrix directly based on the flange coordinate system. The difference in the load inertia matrices in different coordinate systems is mainly reflected in the transformation matrix A.

[0161] Specifically, for a sphere, after the geometric size information is known, the following information can be calculated:

[0162]

[0163] Among them, V 球is the volume of the sphere, π is the circumference of the sphere, and R is the radius of the sphere.

[0164] Specifically, for a cylinder, after knowing the geometric size information, the following information can be calculated:

[0165] V 柱 =πr 2 h

[0166] Among them, V 柱 is the volume of the cylinder, π is the circumference of a circle, r is the radius of the base of the cylinder, and h is the height of the cylinder.

[0167] In the above technical solution, only a simple measurement of the load is required to obtain the complete data required for calculating the load parameters.

[0168] In some technical schemes, optionally, when the geometric shape of the load is a rectangular parallelepiped, the geometric dimension information includes the length, width and height of the rectangular parallelepiped; when the geometric shape of the load is a sphere, the geometric dimension information includes the radius value of the sphere; when the geometric shape of the load is an ellipsoid, the geometric dimension information includes the equatorial radius value and the polar radius value; when the geometric shape of the load is a cylinder, the geometric dimension information includes the base radius value and the height of the cylinder.

[0169] From the above, we can see that for a rigid body, the principal inertia matrix based on the center of mass O is O I m for:

[0170]

[0171] Then for a cuboid, the principal inertia matrix is O I m for:

[0172]

[0173] Among them, m is the weight measurement value of the load, a1, b1 and c1 are geometric size information, and a1, b1 and c1 are the length, width and height of the cuboid respectively.

[0174] For a sphere, the principal moment of inertia matrix O I m for:

[0175]

[0176] Where m is the weight measurement of the load and R is the geometric size information.

[0177] For an ellipsoid, the principal moment of inertia matrix O I m for:

[0178]

[0179] Among them, m is the weight measurement value of the load, a2, b2 and c2 are geometric size information, a2, b2 are the equatorial radius values, and c2 is the polar radius value.

[0180] For a cylinder, the principal moment of inertia matrix O I m for:

[0181]

[0182] Among them, m is the weight measurement of the load, r and h are geometric size information, r is the base radius of the cylinder, and h is the height of the cylinder.

[0183] In this application, only a few common load geometric shapes such as spheres, cuboids and cylinders are listed, but this method is also applicable to other basic geometric shapes, such as: rings, hollow balls, hollow cuboids, hollow spheres, prisms, hexahedrons, etc., only the mathematical formulas need to be expanded, which will not be repeated here.

[0184] According to a fifth aspect of the present invention, the present invention provides a load parameter verification device, comprising: a second acquisition unit, used to obtain a first load parameter when receiving a set load parameter, the first load parameter being a load parameter determined based on first measurement data, the first measurement data being measurement data obtained by measuring the load; a verification unit, used to output the set load parameter based on a verification result of the first load parameter and the set load parameter.

[0185] In this technical solution, since the first load parameter is a load parameter determined based on the first measurement data, the first load parameter can accurately express the actual situation of the load. In the process of using the first load parameter to verify the set load parameter, when the set load parameter is abnormal, the abnormal set load parameter can be verified.

[0186] In this process, the set load parameters are the load parameters used when the robot is running. If there is an abnormality in the set load parameters, the robot operation will become abnormal. By verifying the set load parameters, the impact of abnormal load parameters on the robot operation can be reduced, thereby ensuring the stable operation of the robot.

[0187] In the above technical solution, receiving the set load parameter can be used as a condition for obtaining the first load parameter, thereby realizing automatic acquisition of the first load parameter. At this time, automatic verification of the set load parameter can be realized without user participation.

[0188] In the above technical solution, the load parameters, that is, the load parameters given by the user, can be set, which can be input through the robot's operating interface, or can be input using a terminal or server that interacts with the robot. The specific form will not be repeated here.

[0189] In some technical solutions, the set load parameters may be the default load parameters of the robot, or the load parameters used when the robot last ran.

[0190] In addition, the load parameter verification device proposed in this application also has the following additional technical features.

[0191] In some technical schemes, optionally, setting the load parameters includes setting the weight value, setting the center of mass coordinates and setting the inertia matrix, the first load parameters include the load weight value, the load center of mass coordinates and the load inertia matrix, and the verification unit is specifically used to: determine the weight difference between the set weight value and the load weight value, determine the coordinate deviation between the set center of mass coordinates and the load center of mass coordinates, and determine the matrix deviation between the set inertia matrix and the load inertia matrix; based on the weight difference, coordinate deviation and matrix deviation being less than or equal to the corresponding thresholds, output the set load parameters.

[0192] In this technical solution, the set load parameters are the same as the first load parameters. The difference is that the set load parameters are the load parameters given by the user or used by the robot by default. Therefore, the set load parameters and the first load parameters both contain three parts, namely, the load weight value, the load center of mass coordinates and the load inertia matrix. In order to distinguish, the load weight value in the set load parameters is expressed as the set weight value, the load center of mass coordinates in the set load parameters are expressed as the set center of mass coordinates, and the load inertia matrix in the set load parameters is expressed as the set inertia matrix.

[0193] Based on this, the verification between the first load parameter and the set load parameter mainly includes three parts, namely: verification of the set weight value, verification of the set center of mass coordinates and verification of the set inertia matrix, and the set load parameter is output only when the verification of the three parts passes.

[0194] Specifically, by calculating the weight difference, coordinate deviation and matrix deviation, and when the weight difference, coordinate deviation and matrix deviation are respectively within corresponding thresholds, the set load parameters are output.

[0195] Obviously, in this process, it can be ensured that the set load parameter is almost consistent with the first load parameter, thereby ensuring the accuracy of the set load parameter.

[0196] When the robot works with set load parameters, the control accuracy and motion performance of the robot can be ensured.

[0197] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0198] In the above technical solution, corresponding thresholds are used to compare the set weight value, the set center of mass coordinates and the set inertia matrix respectively, so as to ensure the accuracy of the verification.

[0199] Specifically, the threshold includes a first threshold, a second threshold and a third threshold, wherein the first threshold is the product of the set weight value and a first preset percentage, the second threshold is the product of the set center of mass coordinates and a second preset percentage, and the third threshold is the product of the first value and the third preset percentage, wherein the first value is related to the set inertia matrix.

[0200] Based on the weight difference, coordinate deviation and matrix deviation being less than or equal to the corresponding thresholds, the set load parameters are output, specifically including: based on the weight difference being less than or equal to the first threshold, the coordinate deviation being less than or equal to the second threshold, and each element in the matrix deviation being less than or equal to the third threshold, the set load parameters are output.

[0201] In some technical solutions, optionally, the first preset percentage, the second preset percentage and the third preset percentage are different percentages or the same percentages.

[0202] Exemplarily, the first preset percentage, the second preset percentage and the third preset percentage are 5%.

[0203] In some technical schemes, optionally, the verification unit is also used to: output a first reminder message based on a weight difference being greater than a threshold corresponding to the weight difference; output a second reminder message based on a coordinate deviation being greater than a threshold corresponding to the coordinate deviation; output a third reminder message based on a matrix deviation being greater than a threshold corresponding to the matrix deviation; wherein the first reminder message is used to remind the user to update the set weight value, the second reminder message is used to remind the user to update the set center of mass coordinates, and the third reminder message is used to remind the user to update the set inertia matrix.

[0204] In this technical solution, by outputting the first reminder information, the second reminder information and the third reminder information, the user can update the set load parameters according to the first reminder information, the second reminder information and the third reminder information, so that the updated set load parameters and the first load parameters meet the verification conditions, and finally output accurate load parameters to the robot.

[0205] In the above technical solution, the first reminder information, the second reminder information and the third reminder information can be output in the form of text. In this process, the user can modify the set load parameters by viewing the text, thereby improving the efficiency of modifying the set load parameters.

[0206] In some technical solutions, optionally, the second acquisition unit is specifically used to: acquire first measurement data, the first measurement data including a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; determine the geometric dimension information of the load; determine the first load parameter based on the weight measurement value, distance measurement value and geometric dimension information of the load.

[0207] In this technical solution, after obtaining or receiving the first measurement data obtained after the load measurement, the load parameters are generated based on the first measurement data. In this process, the first measurement data used to generate the load parameters is obtained by the load measurement, which can make the generated first load parameters have higher accuracy.

[0208] In the above technical solution, the flange has a mounting surface for assembling the load, and the flange center can be understood as the center position of the mounting surface.

[0209] In the above technical solution, the geometric center of the load can be understood as the physical center of the load in the xyz coordinate system.

[0210] For example, in the xyz coordinate system, the length of the load in the x-axis direction is x1, the length in the y-axis direction is y1, and the length in the z-axis direction is z1. The coordinates of the physical center are (x1 / 2, y1 / 2, z1 / 2). When the flange center is the origin, the distance measurement values ​​are x1, y1 and z1.

[0211] In the above technical solution, the weight measurement value can be measured by a weight measuring device, such as by weighing the weight of the load using an electronic scale, or can be read from the nameplate of the load.

[0212] In the above technical solution, the geometric dimension information can be understood as the outer dimensions of the load. By obtaining the geometric dimension information, the geometric dimension information can be used to describe the shape of the load, and then in the process of determining the first load parameter, the load inertia matrix in the first load parameter can be accurately described. In this process, the first measurement data is a measurable parameter of the load, and the parameters that are difficult to directly measure can be calculated by mathematical methods to ensure the accuracy of the generated first load parameter.

[0213] According to a sixth aspect of the present invention, the present invention provides a load parameter comparison device, comprising: a third acquisition unit, used to acquire measurement data obtained by measuring the load and to acquire set load parameters; a third determination unit, used to determine a first graph based on the measurement data, the first graph being a graph represented by a first load, and the first load being the load represented by the measurement data; a fourth determination unit, used to determine a second graph based on the measurement data and the set load parameters; and a display unit, used to display the first graph and the second graph.

[0214] In this technical solution, the measurement data is the data obtained by measuring the load, so it can accurately express the actual state of the load. Therefore, the first graph determined based on the measurement data of the load can express the actual state of the load, and the set load parameters are the load parameters set by the user. After graphing them, a second graph can be obtained. The second graph is used to describe the load represented by the set load parameters. By displaying the first graph and the second graph, the user can compare and view the first graph and the second graph, and then determine whether the set load parameters are correct.

[0215] In this process, the input information is converted into geometric figures, and the load data can be matched one-to-one with the actual load geometric dimensions. The load information is displayed intuitively, which can help users check for load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0216] The above detection only requires a simple measurement of the load, and relatively accurate load information can be obtained through mathematical calculations. It does not require modeling or special hardware support, is simple and convenient, and does not need to be bound to a specific robot. The acquired data is highly universal, and is convenient for on-site debugging and rapid deployment.

[0217] In addition, the load parameter comparison device proposed in this application also has the following additional technical features.

[0218] In some technical solutions, optionally, the measurement data includes a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; the third determination unit is specifically used to: obtain geometric dimension information of the load; determine a first figure based on the weight measurement value and the geometric dimension information; wherein the geometric center of the first figure is determined based on the distance measurement value.

[0219] In this technical solution, the distance measurement value can accurately reflect the center of mass coordinates of the load, the geometric dimension information of the load can accurately reflect the shape of the load, and the weight measurement value can reflect the weight of the load. The weight measurement value and the geometric dimension information are used to determine the load inertia matrix in the load parameters. Therefore, it can be understood that the first figure is a graphical representation of the load inertia matrix, and the geometric center of the first figure is determined based on the distance measurement value. Therefore, the displayed first figure can realize the visualization of the load, and the user can intuitively view the shape of the load through the first figure; similarly, the second figure can be used to intuitively display the load described by the set load parameters. In the process of comparing the first figure and the second figure, it can be accurately known whether the load described by the set load parameters is the same as the load described by the measured data, thereby realizing the inspection of load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0220] In some technical solutions, optionally, the measurement data includes a distance measurement value and a weight measurement value of the load, the distance measurement value is the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange, setting the load parameters includes setting the center of mass coordinates and setting the inertia matrix, and the fourth determination unit is specifically used to: obtain the geometric dimension information of the load; determine the load inertia matrix based on the weight measurement value, distance measurement value and geometric dimension information of the load; determine the transformation parameters based on the set inertia matrix and the load inertia matrix; transform the first point cloud based on the transformation parameters to obtain a second point cloud, the first point cloud is point cloud data determined based on the measurement data; translate the second point cloud until the geometric center coordinates of the second point cloud after translation are the set center of mass coordinates; and draw a second figure based on the translated second point cloud.

[0221] In this technical solution, since the weight measurement value and distance measurement value of the load are measured data, they are accurate data. Similarly, the geometric dimension information of the load is also data measured by the user, which is also accurate data. Obviously, the load inertia matrix determined based on the weight measurement value, distance measurement value and geometric dimension information of the load is also accurate.

[0222] The transformation parameters are calculated using the set inertia matrix and the calculated load inertia matrix, so that the transformation parameters can be used to change the shape of the point cloud data determined based on the measurement data. In this process, the first point cloud can be resized and rotated to obtain a second point cloud displayed based on the origin. In this process, the second point cloud is the point cloud affected by the transformation parameters, and the transformation parameters are determined based on the set inertia matrix. Therefore, the second point cloud can intuitively represent the shape of the load.

[0223] From the above, it can be seen that the second point cloud is displayed based on the origin, and the graphics corresponding to the set load parameters should be displayed based on the set center of mass coordinates. Therefore, after determining the second point cloud, the second point cloud is translated until the geometric center coordinates of the second point cloud after translation are the set center of mass coordinates. At this time, the translated second point cloud can accurately represent the load described by the set load parameters. Therefore, the second graphic is drawn based on the translated second point cloud so that the second graphic can be used to represent the load described by the set load parameters.

[0224] In this process, the second figure is transformed based on the point cloud. Therefore, it can accurately describe the load described by the set load parameters. In the process of comparing the first figure and the second figure, it can be accurately known whether the load described by the set load parameters is the same as the load described by the measured data, thereby realizing the inspection of load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0225] In some technical solutions, optionally, the fourth determination unit is specifically used to: diagonalize the set inertia matrix to obtain a first matrix; determine transformation parameters based on the first matrix and the load inertia matrix; wherein the transformation parameters include a scaling factor and a rotation matrix.

[0226] In this technical solution, the scaling coefficients include xs, ys and zs, wherein xs, ys and zs correspond to I xx ,I yy ,I zz The three elements are related, and the rotation matrix is ​​the principal axis rotation matrix of inertia.

[0227] In some technical solutions, optionally, the scaling coefficient and the rotation matrix are obtained by singular value decomposition (SVD), or by transformation using other mathematical methods, and the specific decomposition and transformation are not described in detail here.

[0228] In some technical solutions, optionally, the display unit is also used to: determine a deviation value between the first graph and the second graph; and output the set load parameters and the weight measurement value in the measurement data based on the deviation value being less than or equal to a deviation threshold.

[0229] In this technical solution, the deviation value between the first graph and the second graph is calculated so that the deviation value of the first graph and the second graph can be used to represent the difference between the load represented by the measurement data and the load represented by the set load parameters, and then the deviation threshold is used to measure the difference between the load represented by the measurement data and the load represented by the set load parameters. When the difference is small, that is, when the deviation value is less than or equal to the deviation threshold, the set load parameters and the weight measurement value in the measurement data are output.

[0230] In this process, the output data can accurately represent the load conditions, and when the robot works using the generated load parameters, the control accuracy and motion performance of the robot can be ensured.

[0231] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0232] According to the seventh aspect of the present invention, the present invention provides a device for determining load parameters, including a first processor and a first memory, the first memory storing programs or instructions that can be executed on the first processor, and when the program or instructions are executed by the first processor, the steps of the method for determining load parameters as described in any one of the above items are implemented.

[0233] According to an eighth aspect of the present invention, the present invention provides a load parameter verification device, comprising a second processor and a second memory, the second memory storing programs or instructions that can be run on the second processor, and implementing the steps of the load parameter verification method as any one of the above items when the program or instructions are executed by the second processor.

[0234] According to the ninth aspect of the present invention, the present invention provides a load parameter comparison device, comprising a third processor and a third memory, the third memory storing programs or instructions that can be run on the third processor, and the program or instructions, when executed by the third processor, implement the steps of the load parameter comparison method as any one of the above items.

[0235] According to a tenth aspect of the present invention, the present invention provides a readable storage medium, on which a program or instruction is stored, and when the program or instruction is executed by a processor, the steps of any one of the methods described above are implemented.

[0236] According to the eleventh aspect of the present invention, the present invention provides a robot, comprising: a load parameter determination device as described in any one of the above items; and / or a load parameter verification device as described in any one of the above items; and / or a load parameter comparison device as described in any one of the above items; and / or a readable storage medium as described above.

[0237] Additional aspects and advantages of the present invention will be given in part in the following description and in part will be obvious from the following description, or will be learned through practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS

[0238] The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the description of the embodiments in conjunction with the following drawings, in which:

[0239] Figure 1 One of the flow charts of the method for determining load parameters in an embodiment of the present invention is shown;

[0240] Figure 2 A schematic diagram of coordinate transformation in an embodiment of the present invention is shown;

[0241] Figure 3 A schematic diagram of a load graph in an embodiment of the present invention is shown;

[0242] Figure 4 A schematic diagram of a cuboid in a coordinate system according to an embodiment of the present invention is shown;

[0243] Figure 5 A schematic diagram of an ellipsoid in a coordinate system according to an embodiment of the present invention is shown;

[0244] Figure 6 A schematic diagram of a cylinder in a coordinate system according to an embodiment of the present invention is shown;

[0245] Figure 7 A second flow chart of a method for determining load parameters in an embodiment of the present invention is shown;

[0246] Figure 8 One of the flow charts of the method for verifying load parameters in an embodiment of the present invention is shown;

[0247] Fig. 9 The second flowchart of the method for verifying load parameters in the embodiment of the present invention is shown;

[0248] Fig.10 One of the flow charts of the load parameter comparison method in the embodiment of the present invention is shown;

[0249] Fig.11 A second flow chart of a method for comparing load parameters in an embodiment of the present invention is shown;

[0250] Fig.12 A schematic diagram showing the comparison of load parameters in an embodiment of the present invention is shown;

[0251] Fig.13 A schematic block diagram showing a device for determining a load parameter in an embodiment of the present invention is shown;

[0252] Fig.14 A schematic block diagram of a load parameter verification device in an embodiment of the present invention is shown;

[0253] Fig.15 A schematic block diagram of a load parameter comparison device in an embodiment of the present invention is shown;

[0254] Fig.16 A schematic block diagram showing another device for determining load parameters in an embodiment of the present invention is shown;

[0255] Fig.17 A schematic block diagram showing another load parameter verification device in an embodiment of the present invention;

[0256] Fig.18 A schematic block diagram of another load parameter comparison device in an embodiment of the present invention is shown. DETAILED DESCRIPTION

[0257] In order to more clearly understand the above aspects, features and advantages of the present invention, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be noted that the embodiments of the present application and the features in the embodiments can be combined with each other without conflict.

[0258] In the following description, many specific details are set forth to facilitate a full understanding of the present invention. However, the present invention may also be implemented in other ways different from those described herein. Therefore, the protection scope of the present invention is not limited to the specific embodiments disclosed below.

[0259] In one embodiment of the present application, Figure 1 As shown, a method for determining a load parameter is provided, comprising:

[0260] Step 102, obtaining measurement data obtained by measuring the load, the measurement data including a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange;

[0261] Step 104, determining geometric dimension information of the load;

[0262] Step 106 , determining load parameters based on the weight measurement, distance measurement, and geometric dimension information of the load.

[0263] The present invention proposes a method for determining a load parameter, which generates a load parameter based on the measurement data after obtaining or receiving the measurement data obtained after measuring the load by running the load parameter determination method. In this process, the measurement data used to generate the load parameter is obtained by measuring the load, so that the generated load parameter has a higher accuracy.

[0264] In the above embodiments, the flange has a mounting surface for assembling a load, and the center of the flange can be understood as the center position of the mounting surface.

[0265] In the above embodiment, the geometric center of the load can be understood as the physical center of the load in the xyz coordinate system.

[0266] For example, in the xyz coordinate system, the length of the load in the x-axis direction is x1, the length in the y-axis direction is y1, and the length in the z-axis direction is z1. The coordinates of the physical center are (x1 / 2, y1 / 2, z1 / 2). When the flange center is the origin, the distance measurement values ​​are x1, y1 and z1.

[0267] In the above embodiments, the weight measurement value can be measured by a weight measuring device, such as by weighing the weight of the load using an electronic scale, or can be read from a nameplate of the load.

[0268] In the above embodiment, the geometric dimension information can be understood as the outer dimensions of the load. By obtaining the geometric dimension information, the geometric dimension information can be used to describe the shape of the load, and then in the process of determining the load parameters, the load inertia matrix in the load parameters can be accurately described. In this process, the measurement data is a measurable parameter of the load, and the parameters that are difficult to directly measure can be calculated by mathematical methods to ensure the accuracy of the generated load parameters.

[0269] In some embodiments, optionally, the load parameters include: load weight value, load center of mass coordinates and load inertia matrix. The load parameters are determined based on the load weight measurement value, distance measurement value and geometric dimension information, specifically including: using the load weight measurement value as the load weight value; determining the load inertia matrix based on the load weight measurement value and geometric dimension information; determining the load center of mass coordinates based on the distance measurement value.

[0270] In this embodiment, since the weight measurement value is obtained by measuring the load, it can accurately describe the weight of the load, so the weight measurement value can be directly used as the load weight value. Similarly, the distance measurement value can directly describe the shape of the load, and the load center of mass has a direct relationship with the shape of the load, so the load center of mass coordinates can be directly determined based on the distance measurement value.

[0271] The load inertia matrix is ​​related to the weight and geometric dimensions of the load, so the load inertia matrix can be constructed using the weight measurement value and geometric dimension information. In this process, the load weight value, load inertia matrix and load center of mass coordinates involved in the load parameters can all be calculated using the known measurement data and geometric dimension information. Therefore, the load parameters can be automatically generated.

[0272] Compared with the case where the load parameters are given directly, the load parameters calculated by the present application through measurement data and geometric dimension information are more accurate. When the robot works using the generated load parameters, the control accuracy and motion performance of the robot can be ensured.

[0273] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0274] In some embodiments, optionally, for a general rigid body, the load inertia matrix is ​​expressed as:

[0275]

[0276] I xy =I yx =∫ m x'y'dm;I xz =I zx =∫ m x'z'dm;I yz =I zy =∫ m y'z'dm;I xx =∫ m (y' 2 +z' 2 )dm;I yy =∫ m (x' 2 +z' 2 )dm;I zz =∫ m (x' 2 +y' 2 )dm.

[0277] Among them, I xy ,I yx ,I xz ,I zx ,I yz and I zy are the elements of the non-central principal inertia matrix in the load inertia matrix, x', y', z' are the coordinate values ​​of dm on the x-axis, y-axis and z-axis respectively, ∫ m dm represents the integral of mass, I xx ,I yy ,I zz are the elements of the central principal inertia matrix.

[0278] Specifically, if the coordinate origin of the load inertia matrix is ​​the center of mass, then the coordinate axis is the principal axis of inertia. In this case, I xy =I xz =I yz =0, the load inertia matrix becomes:

[0279]

[0280] in, O I m It is called the central principal inertia matrix.

[0281] For a general inertia matrix, the central principal inertia matrix can be obtained by coordinate transformation, and then the general inertia matrix can be obtained by shifting the center and rotating the axis. Specifically, using the inertia matrix represented by the center of mass and principal axis coordinate system, any general inertia matrix can be obtained by shifting the center and rotating the axis.

[0282] like Figure 2 and Figure 3 As shown, from the coordinate system O xyz The central principal inertia matrix under O I m Transform to coordinate system A xy The general inertia matrix under A I m The mathematical expression of is as follows:

[0283] A I m =A TO I m A

[0284] Among them, A is the coordinate transformation matrix, which represents the transformation from coordinate system O xyz Transform to coordinate system A xyz The mathematical relationship of A T is the transpose of A, A I m is the coordinate system A xy The general inertia matrix under .

[0285] Among them, Figure 3 As shown, the coordinate system O determined based on the flange xyz In the diagram, the load graph is described based on the +x-axis, +y-axis, and +z-axis.

[0286] In some embodiments, optionally, determining the geometric size information of the load specifically includes: receiving geometric morphological information of the load, the geometric morphological information of the load is used to represent the geometric shape of the load; displaying a first interface based on the geometric morphological information of the load, the first interface is used to enter the material density of the load or the geometric dimensional information of the load; receiving the geometric dimensional information of the load based on the first interface; or receiving the material density of the load based on the first interface, and determining the geometric dimensional information of the load based on the material density of the load and the weight measurement value of the load.

[0287] In this embodiment, the shape of the load will be different when the robot is in different usage scenarios. In the embodiment of the present application, the user can input geometric shape information according to the actual shape of the load, and then select the first interface that matches the load, and use the first interface to input geometric size information. In this process, the accuracy of the geometric size information of the load can be ensured.

[0288] In the above embodiments, for different loads, the information that the user can know is different. For example, for some loads, the user knows their material density, while for some loads, the user knows the geometric dimension information. Obviously, when the user does not know the geometric dimension information, the geometric dimension information can be indirectly calculated by inputting the material density. In this process, the user can choose to input the material density or directly input the geometric dimension information according to the actual usage scenario. While obtaining the geometric dimension information, it can also meet the needs of different usage scenarios.

[0289] In some embodiments, the first interface is an interface that corresponds one-to-one to the geometric information.

[0290] In this process, the first interface can be used to display an interface that only matches the geometric shape of the load, thereby reducing the display of other irrelevant information, thereby reducing the probability of mis-input or erroneous input of information.

[0291] For a certain load, after the weight measurement value, external dimensions such as distance measurement value, geometric dimension information or density of the load are known, other unknown physical quantities can be calculated through formulas.

[0292] Specifically, for a cuboid, after knowing the geometric size information, the following information can be calculated:

[0293] V 长 =a1×b1×c1

[0294]

[0295] Among them, V 长 is the volume of the cuboid, m is the mass of the cuboid, a1, b1, c1 are the length, width and height of the cuboid, F I m is the load inertia matrix in coordinate system F.

[0296] In industrial robots, the load inertia matrix set in the program needs to be converted according to the parameter definitions of different manufacturers. It can be a load inertia matrix based on the center of mass aligned flange coordinate system, or it can be a load inertia matrix directly based on the flange coordinate system. The difference in the load inertia matrices in different coordinate systems is mainly reflected in the transformation matrix A.

[0297] Specifically, for a sphere, after the geometric size information is known, the following information can be calculated:

[0298]

[0299] Among them, V 球 is the volume of the sphere, π is the circumference of the sphere, and R is the radius of the sphere.

[0300] Specifically, for a cylinder, after knowing the geometric size information, the following information can be calculated:

[0301] V 柱 =πr 2 h

[0302] Among them, V 柱 is the volume of the cylinder, π is the circumference of a circle, r is the radius of the base of the cylinder, and h is the height of the cylinder.

[0303] In the above embodiment, only a simple measurement of the load is required to obtain complete data required for calculating the load parameters.

[0304] In some embodiments, optionally, when the geometric shape of the load is a rectangular parallelepiped, the geometric dimension information includes the length, width and height of the rectangular parallelepiped; when the geometric shape of the load is a sphere, the geometric dimension information includes the radius value of the sphere; when the geometric shape of the load is an ellipsoid, the geometric dimension information includes the equatorial radius value and the polar radius value; when the geometric shape of the load is a cylinder, the geometric dimension information includes the base radius value and the height of the cylinder.

[0305] From the above, we can see that for a rigid body, the principal inertia matrix based on the center of mass O is O I m for:

[0306]

[0307] Then for a cuboid, the principal inertia matrix is O I m for:

[0308]

[0309] Among them, Figure 4 As shown, m is the weight measurement value of the load, a1, b1 and c1 are the geometric size information, a1, b1 and c1 are the length, width and height of the cuboid respectively, where, and is the centroid principal coordinate matrix O xy The three coordinate axes.

[0310] For a sphere, the principal moment of inertia matrix O I m for:

[0311]

[0312] Where m is the weight measurement of the load and R is the geometric size information.

[0313] For an ellipsoid, the principal moment of inertia matrix P I m for:

[0314]

[0315] Among them, m is the weight measurement value of the load, a2, b2 and c2 are geometric size information, a2, b2 are equatorial radius values, and c2 is polar radius value, such as Figure 5 As shown, and is the centroid principal coordinate matrix O xyz The three coordinate axes.

[0316] For a cylinder, the principal moment of inertia matrix O I m for:

[0317]

[0318] Among them, m is the weight measurement of the load, r and h are geometric size information, r is the bottom radius of the cylinder, and h is the height of the cylinder, such as Figure 6 As shown, and is the centroid principal coordinate matrix O xyz The three coordinate axes.

[0319] In this application, only a few common load geometric shapes such as spheres, cuboids and cylinders are listed, but this method is also applicable to other basic geometric shapes, such as: rings, hollow balls, hollow cuboids, hollow spheres, prisms, hexahedrons, etc., only the mathematical formulas need to be expanded, which will not be repeated here.

[0320] In one embodiment, if Figure 7 As shown, the method for determining the load parameters includes:

[0321] Step 702, input m, Lx, Ly, Lz.

[0322] Step 704, mass m.

[0323] Step 706, select load geometry.

[0324] Step 708, center of mass: cm[Lx, Ly, Lz].

[0325] Step 710, select input: feature size or density.

[0326] Step 712, input density: ρ.

[0327] Step 714, input feature size.

[0328] Step 716, feature size.

[0329] Step 718, inertia.

[0330] Step 720: output load parameters.

[0331] Among them, m is the weight measurement value, Lx, Ly, Lz are distance measurement values, load geometry is also the geometric morphology information in this application, and characteristic size is also the geometric size information.

[0332] In one embodiment, Figure 8 As shown, the present invention provides a method for verifying load parameters, comprising:

[0333] Step 802, in the case of receiving the set load parameter, obtaining a first load parameter, the first load parameter is a load parameter determined based on first measurement data, and the first measurement data is measurement data obtained by measuring the load;

[0334] Step 804: output the set load parameter based on the verification result of the first load parameter and the set load parameter.

[0335] In this embodiment, since the first load parameter is a load parameter determined based on the first measurement data, the first load parameter can accurately express the actual situation of the load. In the process of using the first load parameter to verify the set load parameter, when the set load parameter is abnormal, the abnormal set load parameter can be verified.

[0336] In this process, the set load parameters are the load parameters used when the robot is running. If there is an abnormality in the set load parameters, the robot operation will become abnormal. By verifying the set load parameters, the impact of abnormal load parameters on the robot operation can be reduced, thereby ensuring the stable operation of the robot.

[0337] In the above embodiment, receiving the set load parameter can be used as a condition for obtaining the first load parameter, thereby realizing automatic acquisition of the first load parameter. At this time, the automatic verification of the set load parameter can be realized without user participation.

[0338] In the above embodiment, the load parameters, that is, the load parameters given by the user, can be set through the robot's operating interface, or can be input using a terminal or server that interacts with the robot. The specific form will not be repeated here.

[0339] In some embodiments, the set load parameters may be the default load parameters of the robot, or the load parameters used when the robot last ran.

[0340] In some embodiments, optionally, setting the load parameters includes setting a weight value, setting the center of mass coordinates and setting an inertia matrix, the first load parameters include the load weight value, the load center of mass coordinates and the load inertia matrix, and based on the verification result of the first load parameter and the set load parameter, the set load parameters are output, specifically including: determining the weight difference between the set weight value and the load weight value, determining the coordinate deviation between the set center of mass coordinates and the load center of mass coordinates, and determining the matrix deviation between the set inertia matrix and the load inertia matrix; based on the weight difference, coordinate deviation and matrix deviation being less than or equal to the corresponding thresholds, the set load parameters are output.

[0341] In this embodiment, the set load parameters are the same as the first load parameters. The difference is that the set load parameters are the load parameters given by the user or used by the robot by default. Therefore, the set load parameters and the first load parameters both contain three parts, namely, the load weight value, the load center of mass coordinates and the load inertia matrix. In order to distinguish, the load weight value in the set load parameters is expressed as the set weight value, the load center of mass coordinates in the set load parameters are expressed as the set center of mass coordinates, and the load inertia matrix in the set load parameters is expressed as the set inertia matrix.

[0342] Based on this, the verification between the first load parameter and the set load parameter mainly includes three parts, namely: verification of the set weight value, verification of the set center of mass coordinates and verification of the set inertia matrix, and the set load parameter is output only when the verification of the three parts passes.

[0343] Specifically, by calculating the weight difference, coordinate deviation and matrix deviation, and when the weight difference, coordinate deviation and matrix deviation are respectively within corresponding thresholds, the set load parameters are output.

[0344] Obviously, in this process, it can be ensured that the set load parameter is almost consistent with the first load parameter, thereby ensuring the accuracy of the set load parameter.

[0345] When the robot works with set load parameters, the control accuracy and motion performance of the robot can be ensured.

[0346] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0347] In the above embodiment, the corresponding threshold values ​​are used for comparison of the set weight value, the set center of mass coordinates and the set inertia matrix, respectively, so as to ensure the accuracy of the verification.

[0348] Specifically, the threshold includes a first threshold, a second threshold and a third threshold, wherein the first threshold is the product of the set weight value and a first preset percentage, the second threshold is the product of the set center of mass coordinates and a second preset percentage, and the third threshold is the product of the first value and the third preset percentage, wherein the first value is related to the set inertia matrix.

[0349] Based on the weight difference, coordinate deviation and matrix deviation being less than or equal to the corresponding thresholds, the set load parameters are output, specifically including: based on the weight difference being less than or equal to the first threshold, the coordinate deviation being less than or equal to the second threshold, and each element in the matrix deviation being less than or equal to the third threshold, the set load parameters are output.

[0350] In some embodiments, optionally, the first preset percentage, the second preset percentage and the third preset percentage are different percentages or the same percentage.

[0351] Exemplarily, the first preset percentage, the second preset percentage and the third preset percentage are 5%.

[0352] In some embodiments, optionally, based on the weight difference being greater than a threshold corresponding to the weight difference, a first reminder message is output; based on the coordinate deviation being greater than a threshold corresponding to the coordinate deviation, a second reminder message is output; based on the matrix deviation being greater than a threshold corresponding to the matrix deviation, a third reminder message is output; wherein the first reminder message is used to remind the user to update the set weight value, the second reminder message is used to remind the user to update the set center of mass coordinates, and the third reminder message is used to remind the user to update the set inertia matrix.

[0353] In this embodiment, by outputting the first reminder information, the second reminder information and the third reminder information, the user can update the set load parameters according to the first reminder information, the second reminder information and the third reminder information, so that the updated set load parameters and the first load parameters meet the verification conditions, and finally output accurate load parameters to the robot.

[0354] In the above embodiment, the first reminder information, the second reminder information and the third reminder information can be output in the form of text. In this process, the user can modify the set load parameters by viewing the text, thereby improving the efficiency of modifying the set load parameters.

[0355] In some embodiments, optionally, obtaining the first load parameter specifically includes: obtaining first measurement data, the first measurement data including a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; determining the geometric dimension information of the load; determining the first load parameter based on the weight measurement value, the distance measurement value and the geometric dimension information of the load.

[0356] In this embodiment, after obtaining or receiving the first measurement data obtained after measuring the load, the load parameters are generated based on the first measurement data. In this process, the first measurement data used to generate the load parameters is obtained by measuring the load, so that the generated first load parameters have higher accuracy.

[0357] In the above embodiments, the flange has a mounting surface for assembling a load, and the center of the flange can be understood as the center position of the mounting surface.

[0358] In the above embodiment, the geometric center of the load can be understood as the physical center of the load in the xyz coordinate system.

[0359] For example, in the xyz coordinate system, the length of the load in the x-axis direction is x1, the length in the y-axis direction is y1, and the length in the z-axis direction is z1. The coordinates of the physical center are (x1 / 2, y1 / 2, z1 / 2). When the flange center is the origin, the distance measurement values ​​are x1, y1 and z1.

[0360] In the above embodiments, the weight measurement value can be measured by a weight measuring device, such as by weighing the weight of the load using an electronic scale, or can be read from the nameplate of the load.

[0361] In the above embodiment, the geometric dimension information can be understood as the outer dimensions of the load. By obtaining the geometric dimension information, the geometric dimension information can be used to describe the shape of the load, and then in the process of determining the first load parameter, the load inertia matrix in the first load parameter can be accurately described. In this process, the first measurement data is a measurable parameter of the load, and the parameters that are difficult to directly measure can be calculated by mathematical methods, so as to ensure the accuracy of the generated first load parameter.

[0362] In one embodiment, if Fig. 9 As shown, the load parameter verification method includes:

[0363] Step 901, input m, cm, O I m , m0, Lx, Ly, Lz.

[0364] Step 902, mass m.

[0365] Step 903, measuring mass m0.

[0366] Step 904, select load geometry.

[0367] Step 905, inertia O I m .

[0368] Step 906, center of mass: cm0[Lx, Ly, Lz].

[0369] Step 907, center of mass cm.

[0370] Step 908, deviation < threshold value, if the judgment result is yes, execute step 909, if the judgment result is no, execute step 902.

[0371] Step 909, mass m.

[0372] Step 910, select input: feature size or density.

[0373] Step 911, input density: ρ.

[0374] Step 912, input feature size.

[0375] Step 913, feature size.

[0376] Step 914, calculate inertia O I m0 .

[0377] Step 915, deviation < threshold value, if the judgment result is yes, execute step 916, if the judgment result is no, execute step 905.

[0378] Step 916, inertia O I m .

[0379] Step 917, deviation < threshold value, if the judgment result is yes, execute step 918, if the judgment result is no, execute step 907.

[0380] Step 918, center of mass cm.

[0381] Step 919, output load parameters.

[0382] Among them, m0 is the weight measurement value, cm0[Lx, Ly, Lz] is the center of mass determined based on Lx, Ly, Lz, Lx, Ly, Lz are distance measurement values, load geometry is the geometric morphology information in this application, characteristic size is the geometric size information, and cm is the input center of mass.

[0383] In one embodiment, if Fig.10 As shown, the present invention provides a load parameter comparison method, comprising:

[0384] Step 1002, obtaining measurement data obtained by measuring the load and obtaining set load parameters;

[0385] Step 1004, determining a first graph based on the measurement data, the first graph being a graph represented by a first load graphically, and the first load being a load represented by the measurement data;

[0386] Step 1006, determining a second graph based on the measurement data and the set load parameters;

[0387] Step 1008: display the first graphic and the second graphic.

[0388] In this embodiment, the measurement data is the data obtained by measuring the load, and therefore, it can accurately express the actual state of the load. Therefore, the first graph determined based on the measurement data of the load can express the actual state of the load, and the set load parameters are the load parameters set by the user. After graphing them, a second graph can be obtained. The second graph is used to describe the load represented by the set load parameters. By displaying the first graph and the second graph, the user can compare and view the first graph and the second graph, and then determine whether the set load parameters are correct.

[0389] In this process, the input information is converted into geometric figures, and the load data can be matched one-to-one with the actual load geometric dimensions. The load information is displayed intuitively, which can help users check for load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0390] The above detection only requires a simple measurement of the load, and relatively accurate load information can be obtained through mathematical calculations. It does not require modeling or special hardware support, is simple and convenient, and does not need to be bound to a specific robot. The data obtained is highly universal, and is convenient for on-site debugging and rapid deployment.

[0391] In some embodiments, optionally, the measurement data includes a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; determining the first figure based on the measurement data specifically includes: obtaining geometric dimension information of the load; determining the first figure based on the weight measurement value and the geometric dimension information; wherein the geometric center of the first figure is determined based on the distance measurement value.

[0392] In this embodiment, the distance measurement value can accurately reflect the center of mass coordinates of the load, the geometric dimension information of the load can accurately reflect the shape of the load, and the weight measurement value can reflect the weight of the load. The weight measurement value and the geometric dimension information are used to determine the load inertia matrix in the load parameters. Therefore, it can be understood that the first figure is a graphical representation of the load inertia matrix, and the geometric center of the first figure is determined based on the distance measurement value. Therefore, the displayed first figure can realize the visualization of the load, and the user can intuitively view the shape of the load through the first figure; similarly, the second figure can be used to intuitively display the load described by the set load parameters. In the process of comparing the first figure and the second figure, it can be accurately known whether the load described by the set load parameters is the same as the load described by the measured data, thereby realizing the inspection of load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0393] In some embodiments, optionally, the measurement data includes a distance measurement value and a weight measurement value of the load, the distance measurement value is the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange, setting the load parameters includes setting the center of mass coordinates and setting the inertia matrix, and determining the second figure based on the measurement data and the set load parameters specifically includes: obtaining the geometric dimension information of the load; determining the load inertia matrix based on the weight measurement value, distance measurement value and geometric dimension information of the load; determining the transformation parameters based on the set inertia matrix and the load inertia matrix; transforming the first point cloud based on the transformation parameters to obtain a second point cloud, the first point cloud being point cloud data determined based on the measurement data; translating the second point cloud until the geometric center coordinates of the second point cloud after translation are the set center of mass coordinates; and drawing the second figure based on the translated second point cloud.

[0394] In this embodiment, since the weight measurement value and distance measurement value of the load are measured data, they are accurate data. Similarly, the geometric dimension information of the load is also data measured by the user, which is also accurate data. Obviously, the load inertia matrix determined based on the weight measurement value, distance measurement value and geometric dimension information of the load is also accurate.

[0395] The transformation parameters are calculated using the set inertia matrix and the calculated load inertia matrix, so that the transformation parameters can be used to change the shape of the point cloud data determined based on the measurement data. In this process, the first point cloud can be resized and rotated to obtain a second point cloud displayed based on the origin. In this process, the second point cloud is the point cloud affected by the transformation parameters, and the transformation parameters are determined based on the set inertia matrix. Therefore, the second point cloud can intuitively represent the shape of the load.

[0396] From the above, it can be seen that the second point cloud is displayed based on the origin, and the graphics corresponding to the set load parameters should be displayed based on the set center of mass coordinates. Therefore, after determining the second point cloud, the second point cloud is translated until the geometric center coordinates of the second point cloud after translation are the set center of mass coordinates. At this time, the translated second point cloud can accurately represent the load described by the set load parameters. Therefore, the second graphic is drawn based on the translated second point cloud so that the second graphic can be used to represent the load described by the set load parameters.

[0397] In this process, the second figure is transformed based on the point cloud. Therefore, it can accurately describe the load described by the set load parameters. In the process of comparing the first figure and the second figure, it can be accurately known whether the load described by the set load parameters is the same as the load described by the measured data, thereby realizing the inspection of load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0398] In some embodiments, optionally, the transformation parameters are determined based on the set inertia matrix and the load inertia matrix, specifically including: diagonalizing the set inertia matrix to obtain a first matrix; determining the transformation parameters based on the first matrix and the load inertia matrix; wherein the transformation parameters include scaling factors and rotation matrices.

[0399] In this embodiment, the scaling factors include xs, ys and zs, where xs, ys and zs correspond to I xx ,I yy ,I zz The three elements are related, and the rotation matrix is ​​the principal axis rotation matrix of inertia.

[0400] In some embodiments, optionally, the scaling coefficient and the rotation matrix are obtained by singular value decomposition (SVD), or by transformation using other mathematical methods, and the specific decomposition and transformation are not described in detail here.

[0401] In some embodiments, optionally, the comparison method further includes: determining a deviation value between the first graphic and the second graphic; and outputting set load parameters and weight measurement values ​​in the measurement data based on the deviation value being less than or equal to a deviation threshold.

[0402] In this embodiment, the deviation value between the first graph and the second graph is calculated so that the deviation value of the first graph and the second graph can be used to represent the difference between the load represented by the measurement data and the load represented by the set load parameters, and then the deviation threshold is used to measure the difference between the load represented by the measurement data and the load represented by the set load parameters, and when the difference is small, that is, when the deviation value is less than or equal to the deviation threshold, the set load parameters and the weight measurement value in the measurement data are output.

[0403] In this process, the output data can accurately represent the load conditions, and when the robot works using the generated load parameters, the control accuracy and motion performance of the robot can be ensured.

[0404] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0405] In one embodiment, if Fig.11 and Fig.12 As shown, the load parameter comparison method includes:

[0406] Step 1101, input parameters m, cm, O I m , Lx, Ly, Lz.

[0407] Step 1102, measured mass: m0.

[0408] Step 1103, select load geometry.

[0409] Step 1104, select input: feature size or density.

[0410] Step 1105, input density: ρ.

[0411] Step 1106, input feature size.

[0412] Step 1107, calculate the feature size.

[0413] Step 1108, plot the load represented by the measured data.

[0414] Step 1109, calculate the inertia matrix O I m0 .

[0415] Step 1110, inertia matrix O I m .

[0416] Step 1111, diagonalize the inertia matrix: c I m .

[0417] Step 1112, using O I m0 and c I m Calculate: xyz scaling factors xs, ys, zs and the principal axis rotation matrix.

[0418] Step 1113, generate a collective point cloud pointsets (x, y, z) at the origin.

[0419] Step 1114, scaling and rotating the point cloud coordinates to obtain pointsets1.

[0420] Step 1115, translate pointsets1 from the origin to the centroid.

[0421] Step 1116, center of mass cm.

[0422] Step 1117, draw the point cloud into a picture.

[0423] Step 1118, image comparison deviation < threshold value, if the judgment result is yes, execute step 1119, if the judgment result is no, execute step 1120.

[0424] Step 1119, input m, cm, O I m .

[0425] Step 1120, function 2.

[0426] Among them, m0 is the weight measurement value, and function 2 is the load parameter verification method in this application.

[0427] In one embodiment, if Fig.13 As shown, the present invention provides a load parameter determination device 1300, including: a first acquisition unit 1302, used to obtain measurement data obtained by measuring the load, the measurement data including a distance measurement value and a weight measurement value of the load, the distance measurement value is the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; a first determination unit 1304, used to determine the geometric dimension information of the load; a second determination unit 1306, used to determine the load parameters based on the weight measurement value, distance measurement value and geometric dimension information of the load.

[0428] The present invention proposes a load parameter determination device 1300, which generates load parameters based on the measurement data after acquiring or receiving the measurement data obtained after the load measurement. In this process, the measurement data used to generate the load parameters is obtained by the load measurement, so that the generated load parameters have higher accuracy.

[0429] In the above embodiments, the flange has a mounting surface for assembling a load, and the center of the flange can be understood as the center position of the mounting surface.

[0430] In the above embodiment, the geometric center of the load can be understood as the physical center of the load in the xyz coordinate system.

[0431] For example, in the xyz coordinate system, the length of the load in the x-axis direction is x1, the length in the y-axis direction is y1, and the length in the z-axis direction is z1. The coordinates of the physical center are (x1 / 2, y1 / 2, z1 / 2). When the flange center is the origin, the distance measurement values ​​are x1, y1 and z1.

[0432] In the above embodiments, the weight measurement value can be measured by a weight measuring device, such as by weighing the weight of the load using an electronic scale, or can be read from a nameplate of the load.

[0433] In the above embodiment, the geometric dimension information can be understood as the outer dimensions of the load. By obtaining the geometric dimension information, the geometric dimension information can be used to describe the shape of the load, and then in the process of determining the load parameters, the load inertia matrix in the load parameters can be accurately described. In this process, the measurement data is a measurable parameter of the load, and the parameters that are difficult to directly measure can be calculated by mathematical methods to ensure the accuracy of the generated load parameters.

[0434] In some embodiments, optionally, the load parameters include: load weight value, load center of mass coordinates and load inertia matrix. The second determination unit 1306 is specifically used to: use the load weight measurement value as the load weight value; determine the load inertia matrix based on the load weight measurement value and geometric dimension information; determine the load center of mass coordinates based on the distance measurement value.

[0435] In this embodiment, since the weight measurement value is obtained by measuring the load, it can accurately describe the weight of the load, so the weight measurement value can be directly used as the load weight value. Similarly, the distance measurement value can directly describe the shape of the load, and the load center of mass has a direct relationship with the shape of the load, so the load center of mass coordinates can be directly determined based on the distance measurement value.

[0436] The load inertia matrix is ​​related to the weight and geometric dimensions of the load, so the load inertia matrix can be constructed using the weight measurement value and geometric dimension information. In this process, the load weight value, load inertia matrix and load center of mass coordinates involved in the load parameters can all be calculated using the known measurement data and geometric dimension information. Therefore, the load parameters can be automatically generated.

[0437] Compared with the case where the load parameters are given directly, the load parameters calculated by the present application through measurement data and geometric dimension information are more accurate. When the robot works using the generated load parameters, the control accuracy and motion performance of the robot can be ensured.

[0438] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0439] In some embodiments, optionally, for a general rigid body, the load inertia matrix is ​​expressed as:

[0440]

[0441] I xy =I yx =∫ m x'y'dm;I xz =I zx =∫ m x'z'dm;I yz =I zy =∫ m y'z'dm;I xx =∫ m (y' 2 +z' 2 )dm;I yy =∫ m (x' 2 +z' 2 )dm;I zz =∫ m (z' 2 +y' 2 )dm.

[0442] Among them, I xy ,I yx ,I xz ,I zx ,I yz and I zy are the elements of the non-central principal inertia matrix in the load inertia matrix, x', y', z' are the coordinate values ​​of dm on the x-axis, y-axis and z-axis respectively, ∫ m dm represents the integral of mass, I xx ,I yy ,I zz are the elements of the central principal inertia matrix.

[0443] Specifically, if the coordinate origin of the load inertia matrix is ​​the center of mass, then the coordinate axis is the principal axis of inertia. In this case, I xy =I xz =I yz =0, the load inertia matrix becomes:

[0444]

[0445] in, O I m It is called the central principal inertia matrix.

[0446] For a general inertia matrix, the central principal inertia matrix can be obtained by coordinate transformation, and then the general inertia matrix can be obtained by shifting the center and rotating the axis. Specifically, using the inertia matrix represented by the center of mass and principal axis coordinate system, any general inertia matrix can be obtained by shifting the center and rotating the axis.

[0447] From the coordinate system O xyy The central principal inertia matrix under O I m Transform to coordinate system A xyy The general inertia matrix under A I m The mathematical expression of is as follows:

[0448] A I m =A TO I m A

[0449] Among them, A is the coordinate transformation matrix, which represents the transformation from coordinate system O xyz Transform to coordinate system A xyz The mathematical relationship of A T is the transpose of A, A I m is the coordinate system A xyz The general inertia matrix under .

[0450] In some embodiments, optionally, the first determination unit 1304 is specifically used to: receive geometric information of the load, the geometric information of the load is used to represent the geometry of the load; display a first interface based on the geometric information of the load, the first interface is used to enter the material density of the load or the geometric size information of the load; receive the geometric size information of the load based on the first interface; or receive the material density of the load based on the first interface, and determine the geometric size information of the load based on the material density of the load and the weight measurement value of the load.

[0451] In this embodiment, the shape of the load will be different when the robot is in different usage scenarios. In the embodiment of the present application, the user can input geometric shape information according to the actual shape of the load, and then select the first interface that matches the load, and use the first interface to input geometric size information. In this process, the accuracy of the geometric size information of the load can be ensured.

[0452] In the above embodiments, for different loads, the information that the user can know is different. For example, for some loads, the user knows their material density, while for some loads, the user knows the geometric dimension information. Obviously, when the user does not know the geometric dimension information, the geometric dimension information can be indirectly calculated by inputting the material density. In this process, the user can choose to input the material density or directly input the geometric dimension information according to the actual usage scenario. While obtaining the geometric dimension information, it can also meet the needs of different usage scenarios.

[0453] In some embodiments, the first interface is an interface that corresponds one-to-one to the geometric information.

[0454] In this process, the first interface can be used to display an interface that only matches the geometric shape of the load, thereby reducing the display of other irrelevant information, thereby reducing the probability of mis-input or erroneous input of information.

[0455] For a certain load, after the weight measurement value, external dimensions such as distance measurement value, geometric dimension information or density of the load are known, other unknown physical quantities can be calculated through formulas.

[0456] Specifically, for a cuboid, after knowing the geometric size information, the following information can be calculated:

[0457] V 长 =a1×b1×c1

[0458] m=ρ×V 长

[0459]

[0460] Among them, V 长 is the volume of the cuboid, m is the mass of the cuboid, a1, b1, c1 are the length, width and height of the cuboid, F I m is the load inertia matrix in coordinate system F.

[0461] In industrial robots, the load inertia matrix set in the program needs to be converted according to the parameter definitions of different manufacturers. It can be a load inertia matrix based on the center of mass aligned flange coordinate system, or it can be a load inertia matrix directly based on the flange coordinate system. The difference in the load inertia matrices in different coordinate systems is mainly reflected in the transformation matrix A.

[0462] Specifically, for a sphere, after the geometric size information is known, the following information can be calculated:

[0463]

[0464] Among them, V 球is the volume of the sphere, π is the circumference of the sphere, and R is the radius of the sphere.

[0465] Specifically, for a cylinder, after knowing the geometric size information, the following information can be calculated:

[0466] V 柱 =πr 2 h

[0467] Among them, V 柱 is the volume of the cylinder, π is the circumference of a circle, r is the radius of the base of the cylinder, and h is the height of the cylinder.

[0468] In the above embodiment, only a simple measurement of the load is required to obtain complete data required for calculating the load parameters.

[0469] In some embodiments, optionally, when the geometric shape of the load is a rectangular parallelepiped, the geometric dimension information includes the length, width and height of the rectangular parallelepiped; when the geometric shape of the load is a sphere, the geometric dimension information includes the radius value of the sphere; when the geometric shape of the load is an ellipsoid, the geometric dimension information includes the equatorial radius value and the polar radius value; when the geometric shape of the load is a cylinder, the geometric dimension information includes the base radius value and the height of the cylinder.

[0470] From the above, we can see that for a rigid body, the principal inertia matrix based on the center of mass O is O I m for:

[0471]

[0472] Then for a cuboid, the principal inertia matrix is O I m for:

[0473]

[0474] Among them, m is the weight measurement value of the load, a1, b1 and c1 are geometric size information, and a1, b1 and c1 are the length, width and height of the cuboid respectively.

[0475] For a sphere, the principal moment of inertia matrix O I m for:

[0476]

[0477] Where m is the weight measurement of the load and R is the geometric size information.

[0478] For an ellipsoid, the principal moment of inertia matrix P I m for:

[0479]

[0480] Among them, m is the weight measurement value of the load, a2, b2 and c2 are geometric size information, a2, b2 are the equatorial radius values, and c2 is the polar radius value.

[0481] For a cylinder, the principal moment of inertia matrix O I m for:

[0482]

[0483] Among them, m is the weight measurement of the load, r and h are geometric size information, r is the base radius of the cylinder, and h is the height of the cylinder.

[0484] In this application, only a few common load geometric shapes such as spheres, cuboids and cylinders are listed, but this method is also applicable to other basic geometric shapes, such as: rings, hollow balls, hollow cuboids, hollow spheres, prisms, hexahedrons, etc., only the mathematical formulas need to be expanded, which will not be repeated here.

[0485] In one embodiment, Fig.14 As shown, the present invention provides a load parameter verification device 1400, including: a second acquisition unit 1402, used to obtain a first load parameter when receiving a set load parameter, the first load parameter is a load parameter determined based on first measurement data, and the first measurement data is measurement data obtained by measuring the load; a verification unit 1404, used to output the set load parameter based on the verification result of the first load parameter and the set load parameter.

[0486] In this embodiment, since the first load parameter is a load parameter determined based on the first measurement data, the first load parameter can accurately express the actual situation of the load. In the process of using the first load parameter to verify the set load parameter, when the set load parameter is abnormal, the abnormal set load parameter can be verified.

[0487] In this process, the set load parameters are the load parameters used when the robot is running. If there is an abnormality in the set load parameters, the robot operation will become abnormal. By verifying the set load parameters, the impact of abnormal load parameters on the robot operation can be reduced, thereby ensuring the stable operation of the robot.

[0488] In the above embodiment, receiving the set load parameter can be used as a condition for obtaining the first load parameter, thereby realizing automatic acquisition of the first load parameter. At this time, the automatic verification of the set load parameter can be realized without user participation.

[0489] In the above embodiment, the load parameters, that is, the load parameters given by the user, can be set through the robot's operating interface, or can be input using a terminal or server that interacts with the robot. The specific form will not be repeated here.

[0490] In some embodiments, the set load parameters may be the default load parameters of the robot, or the load parameters used when the robot last ran.

[0491] In some embodiments, optionally, setting the load parameters includes setting the weight value, setting the center of mass coordinates and setting the inertia matrix, the first load parameters include the load weight value, the load center of mass coordinates and the load inertia matrix, the verification unit 1404 is specifically used to: determine the weight difference between the set weight value and the load weight value, determine the coordinate deviation between the set center of mass coordinates and the load center of mass coordinates, and determine the matrix deviation between the set inertia matrix and the load inertia matrix; based on the weight difference, coordinate deviation and matrix deviation being less than or equal to the corresponding thresholds, output the set load parameters.

[0492] In this embodiment, the set load parameters are the same as the first load parameters. The difference is that the set load parameters are the load parameters given by the user or used by the robot by default. Therefore, the set load parameters and the first load parameters both contain three parts, namely, the load weight value, the load center of mass coordinates and the load inertia matrix. In order to distinguish, the load weight value in the set load parameters is expressed as the set weight value, the load center of mass coordinates in the set load parameters are expressed as the set center of mass coordinates, and the load inertia matrix in the set load parameters is expressed as the set inertia matrix.

[0493] Based on this, the verification between the first load parameter and the set load parameter mainly includes three parts, namely: verification of the set weight value, verification of the set center of mass coordinates and verification of the set inertia matrix, and the set load parameter is output only when the verification of the three parts passes.

[0494] Specifically, by calculating the weight difference, coordinate deviation and matrix deviation, and when the weight difference, coordinate deviation and matrix deviation are respectively within corresponding thresholds, the set load parameters are output.

[0495] Obviously, in this process, it can be ensured that the set load parameter is almost consistent with the first load parameter, thereby ensuring the accuracy of the set load parameter.

[0496] When the robot works with set load parameters, the control accuracy and motion performance of the robot can be ensured.

[0497] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0498] In the above embodiment, the corresponding threshold values ​​are used for comparison of the set weight value, the set center of mass coordinates and the set inertia matrix, respectively, so as to ensure the accuracy of the verification.

[0499] Specifically, the threshold includes a first threshold, a second threshold and a third threshold, wherein the first threshold is the product of the set weight value and a first preset percentage, the second threshold is the product of the set center of mass coordinates and the second preset percentage, and the third threshold is the product of the first value and the third preset percentage, wherein the first value is related to the set inertia matrix, wherein the first value can be selected according to actual usage needs.

[0500] Based on the weight difference, coordinate deviation and matrix deviation being less than or equal to the corresponding thresholds, the set load parameters are output, specifically including: based on the weight difference being less than or equal to the first threshold, the coordinate deviation being less than or equal to the second threshold, and each element in the matrix deviation being less than or equal to the third threshold, the set load parameters are output.

[0501] In some embodiments, optionally, the first preset percentage, the second preset percentage and the third preset percentage are different percentages or the same percentage.

[0502] Exemplarily, the first preset percentage, the second preset percentage and the third preset percentage are 5%.

[0503] In some embodiments, optionally, the verification unit 1404 is also used to: output a first reminder message based on a weight difference being greater than a threshold corresponding to the weight difference; output a second reminder message based on a coordinate deviation being greater than a threshold corresponding to the coordinate deviation; output a third reminder message based on a matrix deviation being greater than a threshold corresponding to the matrix deviation; wherein the first reminder message is used to remind the user to update the set weight value, the second reminder message is used to remind the user to update the set center of mass coordinates, and the third reminder message is used to remind the user to update the set inertia matrix.

[0504] In this embodiment, by outputting the first reminder information, the second reminder information and the third reminder information, the user can update the set load parameters according to the first reminder information, the second reminder information and the third reminder information, so that the updated set load parameters and the first load parameters meet the verification conditions, and finally output accurate load parameters to the robot.

[0505] In the above embodiment, the first reminder information, the second reminder information and the third reminder information can be output in the form of text. In this process, the user can modify the set load parameters by viewing the text, thereby improving the efficiency of modifying the set load parameters.

[0506] Specifically, if at least one element in the matrix deviation is greater than a third threshold, a third reminder message is output.

[0507] In some embodiments, optionally, the second acquisition unit 1402 is specifically used to: acquire first measurement data, the first measurement data including a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; determine the geometric dimension information of the load; determine the first load parameter based on the weight measurement value, distance measurement value and geometric dimension information of the load.

[0508] In this embodiment, after obtaining or receiving the first measurement data obtained after measuring the load, the load parameters are generated based on the first measurement data. In this process, the first measurement data used to generate the load parameters is obtained by measuring the load, so that the generated first load parameters have higher accuracy.

[0509] In the above embodiments, the flange has a mounting surface for assembling a load, and the center of the flange can be understood as the center position of the mounting surface.

[0510] In the above embodiment, the geometric center of the load can be understood as the physical center of the load in the xyz coordinate system.

[0511] For example, in the xyz coordinate system, the length of the load in the x-axis direction is x1, the length in the y-axis direction is y1, and the length in the z-axis direction is z1. The coordinates of the physical center are (x1 / 2, y1 / 2, z1 / 2). When the flange center is the origin, the distance measurement values ​​are x1, y1 and z1.

[0512] In the above embodiments, the weight measurement value can be measured by a weight measuring device, such as by weighing the weight of the load using an electronic scale, or can be read from a nameplate of the load.

[0513] In the above embodiment, the geometric dimension information can be understood as the outer dimensions of the load. By obtaining the geometric dimension information, the geometric dimension information can be used to describe the shape of the load, and then in the process of determining the first load parameter, the load inertia matrix in the first load parameter can be accurately described. In this process, the first measurement data is a measurable parameter of the load, and the parameters that are difficult to directly measure can be calculated by mathematical methods, so as to ensure the accuracy of the generated first load parameter.

[0514] In one embodiment, Fig.15As shown, the present invention provides a load parameter comparison device 1500, including: a third acquisition unit 1502, used to obtain measurement data obtained by measuring the load and to obtain set load parameters; a third determination unit 1504, used to determine a first graph based on the measurement data, the first graph is a graph graphically represented by the first load, and the first load is the load represented by the measurement data; a fourth determination unit 1506, used to determine a second graph based on the measurement data and the set load parameters; a display unit 1508, used to display the first graph and the second graph.

[0515] In this embodiment, the measurement data is the data obtained by measuring the load, and therefore, it can accurately express the actual state of the load. Therefore, the first graph determined based on the measurement data of the load can express the actual state of the load, and the set load parameters are the load parameters set by the user. After graphing them, a second graph can be obtained. The second graph is used to describe the load represented by the set load parameters. By displaying the first graph and the second graph, the user can compare and view the first graph and the second graph, and then determine whether the set load parameters are correct.

[0516] In this process, the input information is converted into geometric figures, and the load data can be matched one-to-one with the actual load geometric dimensions. The load information is displayed intuitively, which can help users check for load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0517] The above detection only requires a simple measurement of the load, and relatively accurate load information can be obtained through mathematical calculations. It does not require modeling or special hardware support, is simple and convenient, and does not need to be bound to a specific robot. The acquired data is highly universal, and is convenient for on-site debugging and rapid deployment.

[0518] In some embodiments, optionally, the measurement data includes a distance measurement value and a weight measurement value of the load, the distance measurement value being the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange; the third determination unit 1504 is specifically used to: obtain geometric dimension information of the load; determine a first figure based on the weight measurement value and the geometric dimension information; wherein the geometric center of the first figure is determined based on the distance measurement value.

[0519] In this embodiment, the distance measurement value can accurately reflect the center of mass coordinates of the load, the geometric dimension information of the load can accurately reflect the shape of the load, and the weight measurement value can reflect the weight of the load. The weight measurement value and the geometric dimension information are used to determine the load inertia matrix in the load parameters. Therefore, it can be understood that the first figure is a graphical representation of the load inertia matrix, and the geometric center of the first figure is determined based on the distance measurement value. Therefore, the displayed first figure can realize the visualization of the load, and the user can intuitively view the shape of the load through the first figure; similarly, the second figure can be used to intuitively display the load described by the set load parameters. In the process of comparing the first figure and the second figure, it can be accurately known whether the load described by the set load parameters is the same as the load described by the measured data, thereby realizing the inspection of load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0520] In some embodiments, optionally, the measurement data includes a distance measurement value and a weight measurement value of the load, the distance measurement value is the distance value between the geometric center of the load and the center of the flange after the load is assembled to the flange, setting the load parameters includes setting the center of mass coordinates and setting the inertia matrix, and the fourth determination unit is specifically used to: obtain the geometric dimension information of the load; determine the load inertia matrix based on the weight measurement value, distance measurement value and geometric dimension information of the load; determine the transformation parameters based on the set inertia matrix and the load inertia matrix; transform the first point cloud based on the transformation parameters to obtain a second point cloud, the first point cloud is point cloud data determined based on the measurement data; translate the second point cloud until the geometric center coordinates of the second point cloud after translation are the set center of mass coordinates; and draw a second figure based on the translated second point cloud.

[0521] In this embodiment, since the weight measurement value and distance measurement value of the load are measured data, they are accurate data. Similarly, the geometric dimension information of the load is also data measured by the user, which is also accurate data. Obviously, the load inertia matrix determined based on the weight measurement value, distance measurement value and geometric dimension information of the load is also accurate.

[0522] The transformation parameters are calculated using the set inertia matrix and the calculated load inertia matrix, so that the transformation parameters can be used to change the shape of the point cloud data determined based on the measurement data. In this process, the first point cloud can be resized and rotated to obtain a second point cloud displayed based on the origin. In this process, the second point cloud is the point cloud affected by the transformation parameters, and the transformation parameters are determined based on the set inertia matrix. Therefore, the second point cloud can intuitively represent the shape of the load.

[0523] From the above, it can be seen that the second point cloud is displayed based on the origin, and the graphics corresponding to the set load parameters should be displayed based on the set center of mass coordinates. Therefore, after determining the second point cloud, the second point cloud is translated until the geometric center coordinates of the second point cloud after translation are the set center of mass coordinates. At this time, the translated second point cloud can accurately represent the load described by the set load parameters. Therefore, the second graphic is drawn based on the translated second point cloud so that the second graphic can be used to represent the load described by the set load parameters.

[0524] In this process, the second figure is transformed based on the point cloud. Therefore, it can accurately describe the load described by the set load parameters. In the process of comparing the first figure and the second figure, it can be accurately known whether the load described by the set load parameters is the same as the load described by the measured data, thereby realizing the inspection of load parameter input errors, reverse load installation, load parameter estimation errors, etc.

[0525] In some embodiments, optionally, the fourth determination unit 1506 is specifically used to: diagonalize the set inertia matrix to obtain a first matrix; determine transformation parameters based on the first matrix and the load inertia matrix; wherein the transformation parameters include a scaling factor and a rotation matrix.

[0526] In this embodiment, the scaling factors include xs, ys and zs, where xs, ys and zs correspond to I xx ,I yy ,I zz The three elements are related, and the rotation matrix is ​​the principal axis rotation matrix of inertia.

[0527] In some embodiments, optionally, the scaling coefficient and the rotation matrix are obtained by singular value decomposition (SVD), or by transformation using other mathematical methods, and the specific decomposition and transformation are not described in detail here.

[0528] In some embodiments, optionally, the display unit is further used to: determine a deviation value between the first graph and the second graph; and output the set load parameters and the weight measurement value in the measurement data based on the deviation value being less than or equal to a deviation threshold.

[0529] In this embodiment, the deviation value between the first graph and the second graph is calculated so that the deviation value of the first graph and the second graph can be used to represent the difference between the load represented by the measurement data and the load represented by the set load parameters, and then the deviation threshold is used to measure the difference between the load represented by the measurement data and the load represented by the set load parameters, and when the difference is small, that is, when the deviation value is less than or equal to the deviation threshold, the set load parameters and the weight measurement value in the measurement data are output.

[0530] In this process, the output data can accurately represent the load conditions, and when the robot works using the generated load parameters, the control accuracy and motion performance of the robot can be ensured.

[0531] In this process, the deviation between the robot instructions and the actual data can be reduced, reducing the probability of triggering the robot's internal safety mechanism and causing the robot to alarm and shut down.

[0532] In some embodiments, optionally, Fig.16 As shown, the present invention provides a device 1600 for determining a load parameter, comprising a first processor 1602 and a first memory 1604, wherein the first memory 1604 stores a program or instruction that can be executed on the first processor 1602, and when the program or instruction is executed by the first processor 1602, the steps of the method for determining a load parameter as described above are implemented.

[0533] In some embodiments, optionally, Fig.17 As shown, the present invention provides a load parameter verification device 1700, including a second processor 1702 and a second memory 1704, the second memory 1704 stores programs or instructions that can be run on the second processor 1702, and when the program or instruction is executed by the second processor 1702, the steps of the load parameter verification method as described above are implemented.

[0534] In some embodiments, optionally, Fig.18 As shown, the present invention provides a load parameter comparison device 1800, including a third processor 1802 and a third memory 1804, the third memory 1804 stores programs or instructions that can be executed on the third processor 1802, and when the program or instruction is executed by the third processor 1802, the steps of the load parameter comparison method as described above are implemented.

[0535] Among them, the memory can be used to store software programs and various data. The memory mainly includes a first storage area for storing programs or instructions and a second storage area for storing data, wherein the first storage area can store an operating system, an application program or instructions required for at least one function (such as a sound playback function, an image playback function, etc.), etc. In addition, the memory can include a volatile memory or a non-volatile memory, or the memory can include both volatile and non-volatile memories. Among them, the non-volatile memory can be a read-only memory (ROM), a programmable read-only memory (PROM), an erasable programmable read-only memory (EPROM), an electrically erasable programmable read-only memory (EEPROM), or a flash memory. The volatile memory may be a random access memory (RAM), a static random access memory (SRAM), a dynamic random access memory (DRAM), a synchronous dynamic random access memory (SDRAM), a double data rate synchronous dynamic random access memory (DDRSDRAM), an enhanced synchronous dynamic random access memory (ESDRAM), a synchronous link dynamic random access memory (SLDRAM) and a direct memory bus random access memory (DRRAM). The memory in the embodiments of the present application includes but is not limited to these and any other suitable types of memory.

[0536] In some embodiments, optionally, the present invention provides a readable storage medium, on which a program or instruction is stored, and when the program or instruction is executed by a processor, the steps of any of the above methods are implemented.

[0537] In some embodiments, optionally, the present invention provides a robot comprising: a load parameter determination device as any of the above; and / or a load parameter verification device as any of the above; and / or a load parameter comparison device as any of the above; and / or a readable storage medium as described above.

[0538] The term "first" or "second" in the specification and claims of the present application may include one or more of the features explicitly or implicitly. In the textual description of the present invention, unless otherwise specified, "plurality" means two or more. In addition, "and / or" in the specification and claims means at least one of the connected objects, and the character " / " generally means that the objects connected before and after are in an "or" relationship.

[0539] In the text description of the present invention, it is understood that, except for explicit provisions and limitations, the terms "installation", "connection" and "connection" should be understood in a broad sense. For example, it can be fixed connection, detachable connection, or integral connection; it can be mechanical structure connection or electrical connection; it can be direct connection between the two, or indirect connection between the two through an intermediate medium, or it can be internal communication between two components. For those skilled in the art, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.

[0540] In the claims, specification and drawings of the present invention, the description of the terms "one embodiment", "some embodiments", "specific embodiments" and the like means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In the claims, specification and drawings of the present invention, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner.

[0541] The above are only preferred embodiments of the present invention and are 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 replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.

Claims

1. A method for determining load parameters, characterized in that: include: Acquire measurement data obtained by measuring the load, the measurement data including a distance measurement value and a weight measurement value of the load, the distance measurement value being a distance value between a geometric center of the load and a center of the flange after the load is assembled to the flange; Determining geometric dimension information of the load; Load parameters are determined based on the weight measurement of the load, the distance measurement, and the geometric dimension information.

2. The method for determining load parameters according to claim 1, characterized in that: The load parameters include: load weight value, load center of mass coordinates and load inertia matrix. The load parameters are determined based on the load weight measurement value, the distance measurement value and the geometric dimension information, specifically including: Using the measured weight value of the load as the load weight value; Determining the load inertia matrix based on the weight measurement of the load and the geometric dimension information; The payload center of mass coordinates are determined based on the distance measurements.

3. The method for determining load parameters according to claim 1 or 2, characterized in that: The determining of the geometric dimension information of the load specifically includes: Receiving geometric information of the load, where the geometric information of the load is used to represent the geometric shape of the load; Displaying a first interface based on the geometric shape information of the load, wherein the first interface is used to input the material density of the load or the geometric size information of the load; Receiving geometric dimension information of the load based on the first interface; or A material density of the load is received based on the first interface, and geometric dimension information of the load is determined based on the material density of the load and a weight measurement value of the load.

4. The method for determining load parameters according to claim 3, characterized in that: In the case where the geometric shape of the load is a cuboid, the geometric dimension information includes the length of the cuboid, the width of the cuboid and the height of the cuboid; In the case where the geometric shape of the load is a sphere, the geometric dimension information includes the radius value of the sphere; In the case where the geometric shape of the load is an ellipsoid, the geometric dimension information includes an equatorial radius value and a polar radius value; When the geometric shape of the load is a cylinder, the geometric dimension information includes the bottom radius value of the cylinder and the height of the cylinder.

5. A method for verifying load parameters, characterized in that: include: In case of receiving the set load parameter, obtaining a first load parameter, where the first load parameter is a load parameter determined based on first measurement data, where the first measurement data is measurement data obtained by measuring the load; Based on the verification result of the first load parameter and the set load parameter, the set load parameter is output.

6. The method for verifying load parameters according to claim 5, characterized in that: The set load parameters include a set weight value, a set center of mass coordinates, and a set inertia matrix, wherein the first load parameters include a load weight value, a load center of mass coordinates, and a load inertia matrix, and outputting the set load parameters based on the verification result of the first load parameters and the set load parameters specifically includes: Determining a weight difference between the set weight value and the load weight value, determining a coordinate deviation between the set center of mass coordinates and the load center of mass coordinates, and determining a matrix deviation between the set inertia matrix and the load inertia matrix; Based on the weight difference, the coordinate deviation and the matrix deviation being less than or equal to corresponding thresholds, the set load parameter is output.

7. The method for verifying load parameters according to claim 6, characterized in that: outputting a first reminder message based on the weight difference being greater than a threshold value corresponding to the weight difference; outputting a second reminder message based on the coordinate deviation being greater than a threshold value corresponding to the coordinate deviation; outputting third reminder information based on that the matrix deviation is greater than a threshold value corresponding to the matrix deviation; Among them, the first reminder information is used to remind the user to update the set weight value, the second reminder information is used to remind the user to update the set center of mass coordinates, and the third reminder information is used to remind the user to update the set inertia matrix.

8. The method for verifying load parameters according to any one of claims 5 to 7, characterized in that: The obtaining of the first load parameter specifically includes: Acquire the first measurement data, wherein the first measurement data includes a distance measurement value and a weight measurement value of the load, wherein the distance measurement value is a distance value between a geometric center of the load and a center of the flange after the load is assembled to the flange; Determining geometric dimension information of the load; The first load parameter is determined based on a weight measurement of the load, the distance measurement, and the geometric dimension information.

9. A method for comparing load parameters, characterized in that: include: Obtaining measurement data obtained by measuring the load and obtaining set load parameters; determining a first graph based on the measurement data, the first graph being a graph graphically represented by a first load, the first load being a load represented by the measurement data; determining a second graph based on the measurement data and the set load parameters; The first graphic and the second graphic are displayed.

10. The load parameter comparison method according to claim 9, characterized in that: The measurement data includes a distance measurement value and a weight measurement value of the load, wherein the distance measurement value is a distance value between a geometric center of the load and a center of the flange after the load is assembled to the flange; The determining of the first graph based on the measurement data specifically includes: Obtaining geometric dimension information of the load; determining a first graphic based on the weight measurement value and the geometric dimension information; Wherein, the geometric center of the first figure is determined based on the distance measurement value.

11. The load parameter comparison method according to claim 9, characterized in that: The measurement data includes a distance measurement value and a weight measurement value of the load, the distance measurement value is a distance value between a geometric center of the load and a center of the flange after the load is assembled to the flange, the setting load parameters includes setting center of mass coordinates and setting an inertia matrix, and determining the second graph based on the measurement data and the setting load parameters specifically includes: Obtaining geometric dimension information of the load; determining a load inertia matrix based on the weight measurement of the load, the distance measurement and the geometric dimension information; Determining transformation parameters based on the set inertia matrix and the load inertia matrix; Transforming the first point cloud based on the transformation parameters to obtain a second point cloud, wherein the first point cloud is point cloud data determined based on the measurement data; The second point cloud is translated until the geometric center coordinates of the second point cloud after translation are the set centroid coordinates; A second graphic is drawn based on the translated second point cloud.

12. The load parameter comparison method according to claim 11, characterized in that: The determining of the transformation parameters based on the set inertia matrix and the load inertia matrix specifically includes: Diagonalizing the set inertia matrix to obtain a first matrix; determining transformation parameters based on the first matrix and the load inertia matrix; The transformation parameters include a scaling factor and a rotation matrix.

13. The load parameter comparison method according to any one of claims 9 to 12, characterized in that: The comparison method also includes: determining a deviation value between the first graph and the second graph; Based on the deviation value being less than or equal to a deviation threshold, the set load parameter and the weight measurement value in the measurement data are output.

14. A device for determining a load parameter, characterized in that: include: a first acquisition unit, configured to acquire measurement data obtained by measuring the load, wherein the measurement data includes a distance measurement value and a weight measurement value of the load, wherein the distance measurement value is a distance value between a geometric center of the load and a center of the flange after the load is assembled to the flange; A first determining unit, used to determine geometric dimension information of the load; The second determination unit is configured to determine a load parameter based on the weight measurement value of the load, the distance measurement value and the geometric dimension information.

15. A load parameter verification device, characterized in that: include: A second acquisition unit is used to acquire a first load parameter when receiving the set load parameter, where the first load parameter is a load parameter determined based on first measurement data, where the first measurement data is measurement data obtained by measuring the load; A verification unit is used to output the set load parameter based on a verification result between the first load parameter and the set load parameter.

16. A load parameter comparison device, characterized in that: include: A third acquisition unit is used to acquire measurement data obtained by measuring the load and to acquire set load parameters; a third determining unit, configured to determine a first graph based on the measurement data, wherein the first graph is a graph graphically represented by a first load, and the first load is a load represented by the measurement data; a fourth determining unit, configured to determine a second graph based on the measurement data and the set load parameter; A display unit is used to display the first graph and the second graph.

17. A device for determining a load parameter, characterized in that: The method comprises a first processor and a first memory, wherein the first memory stores a program or instruction that can be run on the first processor, and when the program or instruction is executed by the first processor, the steps of the method for determining a load parameter as described in any one of claims 1 to 4 are implemented.

18. A load parameter verification device, characterized in that: It comprises a second processor and a second memory, wherein the second memory stores a program or instruction that can be run on the second processor, and when the program or instruction is executed by the second processor, the steps of the load parameter verification method as described in any one of claims 5 to 8 are implemented.

19. A load parameter comparison device, characterized in that: It includes a third processor and a third memory, the third memory stores a program or instruction that can be run on the third processor, and when the program or instruction is executed by the third processor, the steps of the load parameter comparison method as described in any one of claims 9 to 13 are implemented.

20. A readable storage medium, characterized in that: The readable storage medium stores a program or an instruction, and when the program or the instruction is executed by a processor, the steps of the method according to any one of claims 1 to 13 are implemented.

21. A robot, characterized in that: include: The device for determining load parameters according to claim 14 or 17; and / or The load parameter verification device according to claim 15 or 18; and / or The load parameter comparison device according to claim 16 or 19; and / or The readable storage medium of claim 20.

Citation Information

Patent Citations

  • Test method of load of tool end of robot

    CN109483596A

  • Method and device for detecting joint rigidity of robot and robot

    CN113654747A

  • Setting method for balancing load device of heavy-load robot

    CN115026878A

  • Method and device for drawing load range graph of robot and robot

    CN115070776A

  • Enhanced robotic safety awareness and integrity monitoring

    CN116339397A