Multi-axis industrial robot moving trajectory optimization method and system

By analyzing and adjusting the operating data and vibration signals of multi-axis industrial robots in real time, using the ICA algorithm to decompose error signals, calculate the error vibration intensity coefficient and correct the control parameters, the problem of error accumulation of multi-axis industrial robots is solved, and precise control and efficiency are achieved promote.

CN118938646AActive Publication Date: 2024-11-12DONGGUAN TONGYI MACHINE

Patent Information

Application Number
CN202410982895.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-12
Estimated Expiration
2044-07-22

AI Technical Summary

Technical Problem

When multi-axis industrial robots move at high speed, error accumulation is caused by factors affecting nonlinear characteristics, and traditional control algorithms cannot correct it in time and accurately, resulting in reduced accuracy and reduced efficiency.

Method used

By collecting and analyzing the operation monitoring data of multi-axis industrial robots in real time, combining historical data and ICA algorithm to decompose vibration signals, calculate error vibration intensity coefficients, adjust the proportional gain component of the PID controller to correct the error and optimize the operating trajectory.

Benefits of technology

It realizes accurate and reliable control of the operating trajectory of multi-axis industrial robots, improves work efficiency and accuracy, and reduces error accumulation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938646A_ABST
    Figure CN118938646A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of data processing, in particular to a multi-axis industrial robot moving trajectory optimization method and system, and aims at original vibration signals of each axis in a multi-axis system based on an independent component analysis method. The error vibration signal and the complexity factor of the motion posture of the multi-axis industrial robot are analyzed by combining the vibration signal of the real motion, the error vibration intensity coefficient of the error vibration signal is further judged, and the error vibration intensity coefficient of the error vibration signal is fed back to a PID controller of the multi-axis industrial robot; the proportional gain component of the multi-axis linkage interpolation control algorithm is adjusted or corrected, so that the multi-axis linkage interpolation control algorithm is fed back to adjust the corresponding axis control, the operation deviation of nonlinear characteristic influence factors on the multi-axis industrial robot is effectively corrected, and more accurate and reliable multi-axis industrial robot operation track control is achieved. Optimization of the moving trajectory of the multi-axis industrial robot is achieved, and the working efficiency of the multi-axis industrial robot is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of data processing, and in particular to a method and system for optimizing the running trajectory of a multi-axis industrial robot. Background Art

[0002] A multi-axis industrial robot is a robot system with multiple degrees of freedom (axes), each of which can be independently controlled. This type of robot system is widely used in the field of industrial production and can perform various complex tasks, such as assembly, welding, handling, processing, etc., adapting to various complex working environments and task requirements, thereby reducing labor costs and improving production efficiency and quality.

[0003] In complex working environments and task requirements, multi-axis industrial robots will produce a certain degree of error when moving at high speed due to the influence of nonlinear characteristics such as motion speed, inertia, friction, and elasticity. When performing error correction, the traditional multi-axis linkage interpolation control algorithm cannot correct the error in a timely and accurate manner because the cause of the error is nonlinear. As a result, these errors will continue to accumulate, and ultimately the robot will be unable to accurately reach the predetermined position, thereby reducing work efficiency and accuracy. Summary of the invention

[0004] In order to solve the problem that the existing operation trajectory of a multi-axis industrial robot cannot be accurately and reliably controlled, the present invention provides a method and system for optimizing the operation trajectory of a multi-axis industrial robot.

[0005] A multi-axis industrial robot running trajectory optimization method, comprising:

[0006] Collecting operation monitoring data of the multi-axis industrial robot at different target times in real time, wherein the operation monitoring data includes an original vibration signal of each axis of the multi-axis industrial robot;

[0007] Acquire a historical data set of the historical operation of the multi-axis industrial robot;

[0008] Analyzing the complexity factor of the motion posture of the multi-axis industrial robot at different target times according to the historical data set;

[0009] For different target moments, the corresponding original vibration signal is analyzed to obtain the error vibration signal;

[0010] Calculating error vibration intensity coefficients at different target moments according to the error vibration signal and the complexity factor;

[0011] Calculate the correction proportional gain component according to the error vibration intensity coefficient at all target moments;

[0012] The running trajectory of the robot is optimized according to the proportional gain component.

[0013] The historical data set includes the historical power and historical speed of each axis, the historical power under the same motion posture is the same type of power data, and the historical speed under the same motion posture is the same type of speed data;

[0014] Analyzing the complexity factor of the motion posture of the multi-axis industrial robot at different target times according to the historical data set specifically includes:

[0015] Calculate the information entropy of a single axis based on the probability of similar power data and similar speed data of the axis appearing in the historical data set, so as to obtain the information entropy of each axis of the industrial robot under the corresponding machine posture;

[0016] Calculating the joint entropy between each pair of axes based on similar power data of each pair of axes and similar speed data of each pair of axes, respectively, to obtain the joint entropy of each pair of axes of the industrial robot under the corresponding machine posture, wherein any two axes form a pair of axes;

[0017] Obtaining a motion posture at a target moment;

[0018] According to the information entropy and the joint entropy corresponding to the motion posture, the complexity factor of the motion posture at the target moment is calculated to obtain the complexity factors of the motion posture at different target moments.

[0019] The step of analyzing the corresponding original vibration signal to obtain the error vibration signal specifically includes:

[0020] Decomposing the original vibration signal using an ICA algorithm to obtain a plurality of decomposition results, wherein each decomposition result includes a first component signal and a second component signal;

[0021] Using a polynomial fitting method, the first component signal in each decomposition result is respectively fitted into a function curve to obtain all amplitude type distribution probabilities of the first component signal in each decomposition result;

[0022] Calculate the kurtosis coefficient and skewness coefficient of the amplitude type distribution of the first component signal in each decomposition result according to all the amplitude type distribution probabilities;

[0023] Constructing an original vibration signal decomposition function based on the kurtosis coefficient and the skewness coefficient;

[0024] Based on the original vibration signal decomposition function, the function output values ​​of all decomposition results are calculated to obtain all output values ​​of the original vibration signal decomposition function, and the decomposition result corresponding to the maximum output value is selected as the optimal decomposition result of the original vibration signal, and the second signal component corresponding to the optimal decomposition result is the error vibration signal.

[0025] Wherein, the error vibration signal includes a plurality of error vibration component signals;

[0026] The step of calculating the error vibration intensity coefficient at different target moments according to the error vibration signal and the complexity factor specifically includes:

[0027] For a target moment, obtain the signal maximum points of all error vibration component signals;

[0028] Calculate the error vibration delay characteristic factor generated by each signal maximum point;

[0029] The error vibration intensity coefficient of the vibration error signal at the same target moment is calculated based on the error vibration delay characteristic factor at the same target moment and the corresponding motion posture complexity factor to obtain the error vibration intensity coefficient at different target moments.

[0030] The calculation of the correction proportional gain component according to the error vibration intensity coefficient at all target moments specifically includes:

[0031] Normalize the error vibration intensity coefficients of all target moments;

[0032] The modified proportional gain component is calculated based on the normalized error vibration intensity coefficient and the original proportional gain component.

[0033] A multi-axis industrial robot running trajectory optimization system, comprising:

[0034] An acquisition module, used for real-time acquisition of operation monitoring data of the multi-axis industrial robot at different target times, wherein the operation monitoring data includes an original vibration signal of each axis of the multi-axis industrial robot;

[0035] An acquisition module, used to acquire a historical data set of the historical operation of the multi-axis industrial robot;

[0036] A first analysis module, configured to analyze the complexity factor of the motion posture of the multi-axis industrial robot at different target times according to the historical data set;

[0037] The second analysis module is used to analyze the corresponding original vibration signal at different target moments to obtain an error vibration signal;

[0038] A first calculation module, used for calculating the error vibration intensity coefficient at different target moments according to the error vibration signal and the complexity factor;

[0039] A second calculation module is used to calculate a correction proportional gain component according to the error vibration intensity coefficient at all target moments;

[0040] The optimization module is used to optimize the running trajectory of the robot according to the proportional gain component.

[0041] The historical data set includes the historical power and historical speed of each axis, the historical power under the same motion posture is the same type of power data, and the historical speed under the same motion posture is the same type of speed data;

[0042] The first analysis module specifically includes:

[0043] A first calculation unit is used to calculate the information entropy of a single axis based on the probability of similar power data and similar speed data of the axis appearing in the historical data set, so as to obtain the information entropy of each axis of the industrial robot under the corresponding machine posture;

[0044] a second calculation unit, configured to calculate the joint entropy between each pair of axes based on similar power data of each pair of axes and similar speed data of each pair of axes, respectively, so as to obtain the joint entropy of each pair of axes of the industrial robot in the corresponding machine posture, wherein any two axes form a pair of axes;

[0045] A first acquisition unit, used to acquire a motion posture at a target moment;

[0046] The third calculation unit is used to calculate the complexity factor of the motion posture at the target moment according to the information entropy and the joint entropy corresponding to the motion posture, so as to obtain the complexity factors of the motion posture at different target moments.

[0047] Wherein, the second analysis module specifically includes:

[0048] A decomposition unit, used for decomposing the original vibration signal by using an ICA algorithm to obtain a plurality of decomposition results, wherein each decomposition result includes a first component signal and a second component signal;

[0049] A second acquisition unit is used to fit the first component signal in each decomposition result into a function curve using a polynomial fitting method to obtain all amplitude type distribution probabilities of the first component signal in each decomposition result;

[0050] A fourth calculation unit, used for calculating the kurtosis coefficient and the skewness coefficient of the amplitude type distribution of the first component signal in each decomposition result according to all the amplitude type distribution probabilities;

[0051] A construction unit, used for constructing an original vibration signal decomposition function based on the kurtosis coefficient and the skewness coefficient;

[0052] The third acquisition unit is used to calculate the function output values ​​of all decomposition results based on the original vibration signal decomposition function, obtain all output values ​​of the original vibration signal decomposition function, select the decomposition result corresponding to the maximum output value as the optimal decomposition result of the original vibration signal, and the second signal component corresponding to the optimal decomposition result is the error vibration signal.

[0053] Wherein, the error vibration signal includes a plurality of error vibration component signals;

[0054] The first calculation module specifically includes:

[0055] A fourth acquisition unit is used to acquire the signal maximum value points of all error vibration component signals at a target moment;

[0056] A fifth calculation unit, used for calculating the error vibration delay characteristic factor generated by each signal maximum point;

[0057] The sixth calculation unit is used to calculate the error vibration intensity coefficient of the vibration error signal at the same target moment based on the error vibration delay characteristic factor at the same target moment and the corresponding motion posture complexity factor, so as to obtain the error vibration intensity coefficient at different target moments.

[0058] The second calculation module specifically includes:

[0059] A normalization unit, used for normalizing the error vibration intensity coefficients at all target moments;

[0060] The fifth calculation unit is used to calculate the modified proportional gain component based on the normalized error vibration intensity coefficient and the original proportional gain component.

[0061] The present invention has the following beneficial effects: the present invention analyzes the error vibration signal and the complexity factor of the motion posture based on the independent component analysis method for the original vibration signal of each axis in the multi-axis system in combination with the vibration signal of the real motion, further determines the error vibration intensity coefficient of the error vibration signal, and feeds back the error vibration intensity coefficient of the error vibration signal to the PID controller of the multi-axis industrial robot, adjusts or corrects its proportional gain component, and then feeds back to the multi-axis linkage interpolation control algorithm to adjust the corresponding axis control, effectively corrects the operation deviation of the multi-axis industrial robot caused by the influencing factors of the nonlinear characteristics, achieves more accurate and reliable multi-axis industrial robot operation trajectory control, realizes the optimization of the operation trajectory of the multi-axis industrial robot, and improves the work efficiency of the multi-axis industrial robot. BRIEF DESCRIPTION OF THE DRAWINGS

[0062] In order to more clearly illustrate the technical solutions and advantages in the embodiments of the present invention or the prior art, the drawings required for use in the embodiments or the prior art descriptions are briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0063] Figure 1 A schematic flow chart of a method for optimizing the running trajectory of a multi-axis industrial robot provided by one embodiment of the present invention;

[0064] Figure 2 A schematic diagram of a first sub-process of a method for optimizing the running trajectory of a multi-axis industrial robot provided by an embodiment of the present invention;

[0065] Figure 3 A schematic diagram of a second sub-process of a multi-axis industrial robot running trajectory optimization method provided by an embodiment of the present invention;

[0066] Figure 4 A schematic diagram of a third sub-process of a method for optimizing the running trajectory of a multi-axis industrial robot provided by an embodiment of the present invention;

[0067] Figure 5 A schematic diagram of a fourth sub-process of a multi-axis industrial robot running trajectory optimization method provided by an embodiment of the present invention;

[0068] Figure 6 A schematic diagram of a multi-axis industrial robot running trajectory optimization system provided by one embodiment of the present invention;

[0069] Figure 7 A first sub-schematic diagram of a multi-axis industrial robot running trajectory optimization system provided by an embodiment of the present invention;

[0070] Figure 8 A second sub-schematic diagram of a multi-axis industrial robot running trajectory optimization system provided by an embodiment of the present invention;

[0071] Fig. 9 A third sub-schematic diagram of a multi-axis industrial robot running trajectory optimization system provided by an embodiment of the present invention;

[0072] Fig.10 This is a fourth sub-schematic diagram of a multi-axis industrial robot operation trajectory optimization system provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0073] In order to further explain the technical means and effects adopted by the present invention to achieve the predetermined invention purpose, the following is a detailed description of a multi-axis industrial robot operation trajectory optimization method and system proposed by the present invention, its specific implementation, structure, features and effects, in conjunction with the accompanying drawings and preferred embodiments. In the following description, different "one embodiment" or "another embodiment" does not necessarily refer to the same embodiment. In addition, specific features, structures or characteristics in one or more embodiments may be combined in any suitable form.

[0074] Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs.

[0075] The specific scheme of a multi-axis industrial robot running trajectory optimization method and system provided by the present invention is described in detail below with reference to the accompanying drawings.

[0076] For a multi-axis industrial robot system, each axis in the multi-axis system can work independently or collaboratively, so each axis has an independent motor, driver and sensor. The independent motor, driver and sensor of each axis are regarded as sub-controllers of the multi-axis system, responsible for managing and executing motion control tasks related to the axis. The central controller is the main control unit of the multi-axis industrial robot system, responsible for coordinating the motion of each axis. The control unit receives high-level instructions and decomposes them into control commands for a single axis. The multi-axis linkage interpolation control algorithm coordinates the motion between the axes to minimize the asynchrony and error accumulation between the axes to achieve precise motion of the robot. However, in actual systems, due to the influence of dynamic characteristics (such as inertia, friction, elasticity, etc.) and nonlinear effects (such as friction, coupling effect, etc.), a certain degree of error will still occur. Therefore, it is necessary to optimize the feedback logic by combining PID control sensors to more accurately monitor and correct errors in real time on the robot system to achieve higher quality and reliability motion control.

[0077] See also Figure 1 , which shows a method flow chart of a multi-axis industrial robot running trajectory optimization method provided by an embodiment of the present invention, and the fixed-frequency air conditioner indoor unit connection line detection method includes steps S101-S107:

[0078] S101. Collecting operation monitoring data of a multi-axis industrial robot at different target times in real time, wherein the operation monitoring data includes an original vibration signal of each axis of the multi-axis industrial robot.

[0079] An integrated sensor is installed in the multi-axis industrial robot system to collect the operation monitoring data of the motor shaft during the real-time movement of the robot, including the original vibration signal of each axis in the multi-axis motor, and pre-process it, including but not limited to smoothing, denoising, etc., to ensure the accuracy of subsequent analysis.

[0080] S102: Acquire a historical data set of the historical operation of the multi-axis industrial robot.

[0081] At the same time, the input power and speed of each axis in the robot's multi-axis system and historical feature data under different postures are obtained, and these historical feature data constitute a historical data set.

[0082] S103: Analyze the complexity factor of the motion posture of the multi-axis industrial robot at different target times according to the historical data set.

[0083] The error of motion posture may lead to a decrease in the accuracy of its positioning and execution of tasks, thus affecting its accuracy. Especially for applications that require high-precision operations (such as assembly, welding, etc.), the posture error at different times may have different effects on the final quality of the product.

[0084] When industrial robots need to perform complex posture changes, more precise control is usually required to ensure that the desired posture is achieved. This means that even a small posture error may have a significant impact on task execution, so more frequent and precise error correction is required.

[0085] Specifically, the complexity of the motion posture at different times can be quantified as the synergy between each axis in the multi-axis system. The greater the synergy, the higher the posture complexity. At any time, the posture of the robot is composed of the power and speed of each axis, and the synergy between the axes is crucial to achieving a specific posture. This embodiment quantitatively characterizes the complexity of the running posture at different times by analyzing the performance of the motion posture at different times in the historical data.

[0086] The historical data set includes the historical power and historical speed of each axis. The historical power under the same motion posture is the same type of power data, and the historical speed under the same motion posture is the same type of speed data.

[0087] Further, in one embodiment, if Figure 2 As shown, step S103 specifically includes the following steps:

[0088] S1031. Calculate the information entropy of a single axis based on the probability of similar power data and similar speed data of the axis appearing in a historical data set, so as to obtain the information entropy of each axis of the industrial robot under the corresponding machine posture.

[0089] S1032. Calculate the joint entropy between each pair of axes based on similar power data of each pair of axes and similar speed data of each pair of axes, so as to obtain the joint entropy of each pair of axes of the industrial robot under the corresponding machine posture, wherein any two axes constitute a pair of axes.

[0090] S1033: Obtain a motion posture at a target moment.

[0091] S1034. Calculate the complexity factor of the motion posture at the target moment according to the information entropy and the joint entropy corresponding to the motion posture, so as to obtain the complexity factors of the motion posture at different target moments.

[0092] For the power and speed historical data of each axis, the probability of the power and speed data under the same motion posture in the historical data appearing in the overall historical data set is obtained, and then the information entropy of the power and speed data of each axis is obtained. At the same time, for the historical data between each pair of axes in the multi-axis system, the joint entropy is calculated, and then the joint entropy is corrected by the information entropy to obtain the final complexity factor of the motion posture of the overall multi-axis system.

[0093] Specifically, the calculation formula of the posture complexity factor of the industrial robot at different target times is:

[0094]

[0095] In the formula, i represents the motion posture of the target robot at the i-th moment, and also represents the i-th motion posture. N represents the total number of axes in the industrial robot multi-axis system, and n represents the n-th axis in the industrial robot multi-axis system. represents the information entropy of the nth axis in the same posture as the i-th motion posture in the historical data, H represents the total number of pairs of the nth axis in the multi-axis system and any axis in the system, and h represents the h-th pair of axes in the H set. represents the joint entropy of the historical input data set of the h-th axis combination in the same posture as the i-th motion posture in the historical data, R i Represents the complexity factor of the i-th motion posture.

[0096] In summary, It represents the product of the information entropy of the historical data set of the nth axis and the joint entropy of the historical data set of the hth axis combination under the same posture as the i-th motion posture in the historical data. The correlation between the historical input data of a single axis and other axes in the multi-axis system is corrected by the disorder degree of the historical input data of the single axis to obtain the corrected correlation degree between each axis and other axes of the system. The larger the value, the more concentrated the distribution range of the historical data of the nth axis is, and the greater the contribution of the axis in forming the robot's motion posture, because its motion is more stable and controllable. Therefore, the weight of the correlation degree of the axis with other axes in the synergy of the overall multi-axis system is increased;

[0097] It represents the weighted average of the corrected correlation factors between all single axes of the multi-axis system and other axes in the motion posture of the industrial robot at the target moment. The larger the value, the stronger the correlation between the multi-axis systems in the motion posture of the industrial robot at the target moment, which means that the synergy factor between each axis in the multi-axis system is larger, and the higher the posture complexity of the industrial robot in the i-th motion posture, the higher the R i The larger the value of .

[0098] S104. For different target moments, analyze the corresponding original vibration signal to obtain an error vibration signal.

[0099] Independent component analysis (ICA) is a common signal processing algorithm that can be used to decompose multiple mixed signals and effectively separate the component signals of the original signal, each component corresponding to an independent source in the system.

[0100] In a multi-axis industrial robot system, the vibration signal generated during high-speed motion can be regarded as a composite signal mixed from multiple sources, which includes both the electric shaft vibration signal generated by the real motion and the error vibration signal caused by factors such as friction and inertia (originating from the robot's mechanical structure, friction between connectors, and inertia of components). When the vibration signal analysis results are used as feedback conditions for the multi-axis linkage interpolation control algorithm in the control system, there are errors, which leads to a decrease in the accuracy of the robot's behavior trajectory.

[0101] The integrated sensor is used to obtain the vibration signal generated by the multi-axis industrial robot system at different movement speeds. The ICA algorithm is used to decompose the original vibration signal to remove the low-frequency signal caused by non-high-speed movement, namely the vibration error signal.

[0102] In one embodiment, if Figure 3 As shown, step S104 specifically includes the following steps:

[0103] S1041. Decompose the original vibration signal using an ICA algorithm to obtain a plurality of decomposition results, wherein each decomposition result includes a first component signal and a second component signal.

[0104] It should be noted that the ICA algorithm set in the present application can obtain several signal decomposition results, and there are two component signals in each decomposition result. The signal with a relatively large decomposition integral is regarded as the first component signal, and the remaining decomposition signal is regarded as the second component signal. In a multi-axis industrial robot system, a normal vibration signal should have a certain periodicity. This is because when the industrial robot performs various operations, its mechanical parts will produce regular vibrations, and the real industrial robot multi-axis system vibration signal is affected by multiple vibration modes and is often non-Gaussian.

[0105] S1042: Use a polynomial fitting method to fit the first component signal in each decomposition result into a function curve to obtain all amplitude type distribution probabilities of the first component signal in each decomposition result.

[0106] S1043. Calculate the kurtosis coefficient and the skewness coefficient of the amplitude type distribution of the first component signal in each decomposition result according to all the amplitude type distribution probabilities.

[0107] Specifically, for the first component signal obtained in any decomposition result, a polynomial fitting method is used to fit it into a function curve, and the distribution probabilities of all amplitude types in the first component signal are obtained. Then, according to the known technology, the kurtosis coefficient and skewness coefficient of the amplitude type distribution of the first component signal can be obtained for subsequent analysis and screening of the decomposition results.

[0108] S1044. Construct an original vibration signal decomposition function based on the kurtosis coefficient and the skewness coefficient.

[0109] Specifically, the formula of the original vibration signal decomposition function is:

[0110]

[0111] In the formula, K i represents the kurtosis coefficient of all amplitude types in the first component signal of the multi-axis system under the i-th motion posture, U i represents the skewness coefficient of all amplitude type distributions in the first component signal of the multi-axis system under the i-th motion posture, T i represents the total number of all signal sampling points in the first component signal of the multi-axis system under the i-th motion posture, t i represents the tth signal sampling point in the first component signal of the multi-axis system under the i-th motion posture, f i(t) represents the fitting function of the first component signal of the multi-axis system under the i-th motion posture, f i (t+γ) represents the fitting delay function of the first component signal of the multi-axis system under the i-th motion posture, γ represents the delay amount, H i (t) represents the decomposition function of the original vibration signal of the multi-axis system under the i-th motion posture of the system. That is, t represents time, H i (t) represents the decomposition function of the original vibration signal corresponding to the motion posture with respect to time.

[0112] In summary, (K i ×U i ) represents the product of the kurtosis coefficient and the skewness coefficient of all amplitude type distributions in the first component signal of the multi-axis system under the i-th motion posture. The larger the value, the more skew and irregular the distribution of the signal amplitude is, indicating that the amplitude distribution of the signal deviates more from the Gaussian distribution, that is, the greater the non-Gaussianity is; It represents the fitting function and fitting time delay function of the first component signal of the multi-axis system under the i-th motion posture, calculates the product in the time range from (t=1) to (t=T), and integrates all these products. The value is a specific value from 0 to 1. The closer it is to 1, the stronger the periodicity of the target signal. (It should be noted that since it is impossible to determine the period value of each signal, i.e., the time delay, γ here is an iterative value starting from 0, which increases by 1 each time iteration, gradually approaching the actual period and time delay, so as to find The overall maximum value is taken).

[0113] It represents the sum of the non-Gaussianity and periodicity of the first component signal of the multi-axis system under the i-th motion posture. In the ICA analysis method, the worse the Gaussianity of the component signal is, the better the decomposition result is. At the same time, combined with the fact that the real vibration signal of the robot motion is periodic compared with the error vibration signal, the Gaussianity of the component signal is corrected. The larger the value, the less Gaussian the amplitude distribution of the first component signal is, and the more periodic it is. The greater the possibility that the first component signal is the real electric shaft vibration signal during the robot motion, then H i The larger the value of (t).

[0114] S1045. Calculate the function output values ​​of all decomposition results based on the original vibration signal decomposition function, obtain all output values ​​of the original vibration signal decomposition function, select the decomposition result corresponding to the maximum output value as the optimal decomposition result of the original vibration signal, and the second signal component corresponding to the optimal decomposition result is the error vibration signal.

[0115] The function output values ​​of all decomposition results are calculated by the above formula, and the decomposition result corresponding to the maximum output value H(t) is selected as the optimal result. In this optimal result, the first component signal is regarded as the real electric shaft vibration signal during the robot movement process, and the second component signal is regarded as the error vibration signal.

[0116] S105. Calculate error vibration intensity coefficients at different target times according to the error vibration signal and the complexity factor.

[0117] The error vibration signal includes multiple error vibration component signals. The signal strength is determined based on the obtained error vibration signal. The strength of the error vibration signal determines the control coefficient of the control system. The specific error vibration signal strength can be represented by the characteristic that the delayed vibration signal amplitude of the higher intensity error vibration signal is different from that of the normal vibration signal.

[0118] In one embodiment, if Figure 4 As shown, step S105 specifically includes steps S1051-S1053:

[0119] S1051. For a target moment, obtain the signal maximum points of all error vibration component signals.

[0120] First, the signal maximum points of all error vibration component signals are obtained. For all the signal maximum points in the obtained error vibration signals, a window area is defined with any signal maximum point as the starting point. The size of the window area is set to 20 signal sampling points, which is convenient for the subsequent further analysis of the oscillation signal.

[0121] S1052. Calculate the error vibration delay characteristic factor generated by each signal maximum point.

[0122] S1053. Calculate the error vibration intensity coefficient of the vibration error signal at the same target moment based on the error vibration delay characteristic factor and the corresponding motion posture complexity factor at the same target moment, so as to obtain the error vibration intensity coefficient at different target moments.

[0123] The error vibration delay characteristic factor generated by the signal maximum point may represent the influence of factors such as friction and inertia at the signal maximum point on the error vibration of the multi-axis robot system. Combining the error vibration delay characteristic factor and the complexity factor of the motion posture, a specific error vibration signal error vibration intensity coefficient calculation formula is constructed as follows:

[0124]

[0125] In the formula, R i represents the complexity factor of the ith target moment (i.e., the ith motion posture), Mi represents the set of all maximum points in the multi-axis system error vibration signal under the i-th motion posture, m i represents the mth error vibration signal of the multi-axis system under the i-th motion posture i The maximum point, E mi Represents the mth i The slope at the maximum point, A i represents the mth error vibration signal of the multi-axis system under the i-th motion posture i The maximum value of the signal corresponds to the set of all sampling points in the window area, and a represents the Ath i The a-th signal maximum point in the set, represents the mth error vibration signal of the multi-axis system under the i-th motion posture i The probability of occurrence of the signal amplitude corresponding to the ath signal maximum point in the window area corresponding to the ath signal maximum point in the overall error vibration signal, Q i Represents the error vibration intensity coefficient of the error vibration signal of the multi-axis system under the i-th motion posture.

[0126] In summary, It represents the mth error vibration signal of the multi-axis system under the i-th posture. i The probability of occurrence of the signal amplitude corresponding to the ath signal maximum point in the window area corresponding to the mth signal maximum point in the overall error vibration signal is multiplied, and the multiplication result is the error vibration delay characteristic factor. The smaller the value, the higher the probability of occurrence of the signal amplitude corresponding to the ath signal maximum point in the window area corresponding to the mth signal maximum point in the overall error vibration signal. i In the subsequent window area at the maximum value point of each signal, the signal amplitude has a low probability of occurrence for the overall error vibration signal, and the signal changes in the window of this area are not common, which may mean that factors such as friction and inertia here have a greater impact on the error vibration of the multi-axis robot system; It means that the slope of the error vibration delay characteristic factor of the maximum point is first corrected, and the corrected slopes of all maximum points in the error vibration signal are weighted averaged (that is, the characteristic factors of all maximum points in the signal). The larger the value is, the more significant or more intense the signal change rate at the maximum point in the entire error vibration signal is, and a larger delay vibration is generated, then the error vibration generated by the robot system during movement or operation is more obvious and intense.

[0127] It represents the product of the posture complexity factor under the ith motion posture and the error vibration delay characteristic factor of all maximum points in the signal. The larger the value, the more the intensity coefficient of the error vibration signal is corrected when the complexity of the robot's motion posture is high at the current moment. It is necessary to more effectively suppress the influence of the error on the robot's running trajectory. Then Q iThe larger the value of .

[0128] S106. Calculate a modified proportional gain component according to the error vibration intensity coefficients at all target moments.

[0129] Since the larger the error vibration intensity coefficient of the error vibration signal, the more obvious the vibration error will be on each axis of the multi-axis industrial robot system when it is running at high speed, the proportional gain coefficient P of the PID can be adjusted in the multi-axis linkage interpolation control algorithm so that the control algorithm can stably output the control value under the operating state affected by this nonlinear characteristic.

[0130] In one embodiment, if Figure 5 As shown, step S106 specifically includes the following steps:

[0131] S1061. Normalize the error vibration intensity coefficients at all target moments.

[0132] S1062: Calculate the modified proportional gain component based on the normalized error vibration intensity coefficient and the original proportional gain component. Specifically, construct a modified proportional gain formula:

[0133] K p′ =(1+Q i ′)K p

[0134] In the formula, Q i ′ represents the normalized error vibration intensity coefficient of the multi-axis system error vibration signal of the industrial robot at the ith motion posture (i.e., the ith target moment), K p Represents the proportional gain component of the output before regulation, K p′ It represents the proportional gain component output after correction using the intensity coefficient of the error vibration signal, that is, the corrected proportional gain component.

[0135] S107: Optimizing the running trajectory of the robot according to the modified proportional gain component.

[0136] Finally, the obtained corrected proportional gain component is used to provide feedback to the multi-axis linkage interpolation control algorithm, so that it can better control the power and needle feeding speed of each axis in the multi-axis system, timely correct the accumulated errors generated during the operation of the industrial robot, and improve the operation accuracy of the multi-axis industrial robot.

[0137] The present invention provides a multi-axis industrial robot operation trajectory optimization system. The multi-axis industrial robot operation trajectory optimization system of the present invention corresponds to a multi-axis industrial robot operation trajectory optimization method. For the details not detailed in the multi-axis industrial robot operation trajectory optimization system of the present invention, reference can be made to the specific embodiments of the multi-axis industrial robot operation trajectory optimization method.

[0138] like Figure 6 As shown, the multi-axis industrial robot running trajectory optimization system specifically includes:

[0139] The acquisition module 101 is used to acquire the operation monitoring data of the multi-axis industrial robot at different target times in real time, wherein the operation monitoring data includes the original vibration signal of each axis of the multi-axis industrial robot.

[0140] The acquisition module 102 is used to acquire a historical data set of the historical operation of the multi-axis industrial robot.

[0141] The first analysis module 103 is used to analyze the complexity factor of the motion posture of the multi-axis industrial robot at different target moments according to the historical data set.

[0142] The second analysis module 104 is used to analyze the corresponding original vibration signal at different target moments to obtain the error vibration signal.

[0143] The first calculation module 105 is used to calculate the error vibration intensity coefficient at different target moments according to the error vibration signal and the complexity factor.

[0144] The second calculation module 106 is used to calculate the correction proportional gain component according to the error vibration intensity coefficients at all target moments.

[0145] The optimization module 107 is used to optimize the running trajectory of the robot according to the proportional gain component.

[0146] In one embodiment, the historical data set includes the historical power and historical speed of each axis, the historical power under the same motion posture is the same type of power data, and the historical speed under the same motion posture is the same type of speed data.

[0147] In one embodiment, if Figure 7 As shown, the first analysis module 103 specifically includes:

[0148] The first calculation unit 1031 is used to calculate the information entropy of a single axis based on the probability of similar power data and similar speed data of the axis appearing in the historical data set, so as to obtain the information entropy of each axis of the industrial robot under the corresponding machine posture.

[0149] The second calculation unit 1032 is used to calculate the joint entropy between each pair of axes based on the same power data of each pair of axes and the same speed data of each pair of axes, so as to obtain the joint entropy of each pair of axes of the industrial robot under the corresponding machine posture, wherein any two axes constitute a pair of axes.

[0150] The first acquisition unit 1033 is used to acquire a motion posture at a target moment.

[0151] The third calculation unit 1034 is used to calculate the complexity factor of the motion posture at the target moment according to the information entropy and the joint entropy corresponding to the motion posture, so as to obtain the complexity factors of the motion posture at different target moments.

[0152] In one embodiment, if Figure 8 As shown, the second analysis module 104 specifically includes:

[0153] The decomposition unit 1041 is used to decompose the original vibration signal using the ICA algorithm to obtain a plurality of decomposition results, wherein each decomposition result includes a first component signal and a second component signal.

[0154] The second acquisition unit 1042 is used to fit the first component signal in each decomposition result into a function curve by using a polynomial fitting method, so as to obtain all amplitude type distribution probabilities of the first component signal in each decomposition result.

[0155] The fourth calculation unit 1043 is used to calculate the kurtosis coefficient and the skewness coefficient of the amplitude type distribution of the first component signal in each decomposition result according to all the amplitude type distribution probabilities.

[0156] The construction unit 1044 is used to construct an original vibration signal decomposition function based on the kurtosis coefficient and the skewness coefficient.

[0157] The third acquisition unit 1045 is used to calculate the function output values ​​of all decomposition results based on the original vibration signal decomposition function, obtain all output values ​​of the original vibration signal decomposition function, select the decomposition result corresponding to the maximum output value as the optimal decomposition result of the original vibration signal, and the second signal component corresponding to the optimal decomposition result is the error vibration signal.

[0158] The error vibration signal includes a plurality of error vibration component signals.

[0159] In one embodiment, if Fig. 9 As shown, the first calculation module 105 specifically includes:

[0160] The fourth acquisition unit 1051 is used to acquire the signal maximum value points of all error vibration component signals at a target moment;

[0161] A fifth calculation unit 1052, used to calculate the error vibration delay characteristic factor generated by each signal maximum point;

[0162] The sixth calculation unit 1053 is used to calculate the error vibration intensity coefficient of the vibration error signal at the same target moment based on the error vibration delay characteristic factor at the same target moment and the corresponding motion posture complexity factor to obtain the error vibration intensity coefficient at different target moments.

[0163] In one embodiment, if Fig.10 As shown, the second calculation module 106 specifically includes:

[0164] The normalization unit 1061 is used to normalize the error vibration intensity coefficients at all target moments.

[0165] The seventh calculation unit 1062 is used to calculate the modified proportional gain component based on the normalized error vibration intensity coefficient and the original proportional gain component.

[0166] The present invention provides a method and system for optimizing the running trajectory of a multi-axis industrial robot. Based on the independent component analysis method, the original vibration signal of each axis in the multi-axis system is combined with the periodic characteristics of the vibration signal of the real motion to obtain the error vibration component signal of the optimal decomposition result, and further judge the error vibration intensity coefficient of the error vibration component signal. According to the vibration intensity coefficient of the error vibration component signal, the error vibration component signal is fed back to the PID controller to adjust its correction proportional gain component, and then fed back to the multi-axis linkage interpolation control algorithm to adjust the corresponding axis control, so as to achieve more accurate and reliable multi-axis industrial robot running trajectory control, thereby realizing the optimization of the multi-axis industrial robot running trajectory.

[0167] It should be noted that the sequence of the above embodiments of the present invention is only for description and does not represent the advantages and disadvantages of the embodiments. The processes depicted in the accompanying drawings do not necessarily require the specific order or continuous order shown to achieve the desired results. In some embodiments, multitasking and parallel processing are also possible or may be advantageous.

[0168] The various embodiments in this specification are described in a progressive manner, and the same or similar parts between the various embodiments can be referenced to each other, and each embodiment focuses on the differences from other embodiments.

Claims

1. A method for optimizing the trajectory of a multi-axis industrial robot, characterized in that: The method comprises: Collecting operation monitoring data of the multi-axis industrial robot at different target times in real time, wherein the operation monitoring data includes an original vibration signal of each axis of the multi-axis industrial robot; Acquire a historical data set of the historical operation of the multi-axis industrial robot; Analyzing the complexity factor of the motion posture of the multi-axis industrial robot at different target times according to the historical data set; For different target moments, the corresponding original vibration signal is analyzed to obtain the error vibration signal; Calculating error vibration intensity coefficients at different target moments according to the error vibration signal and the complexity factor; Calculate the correction proportional gain component according to the error vibration intensity coefficient at all target moments; The running trajectory of the robot is optimized according to the modified proportional gain component.

2. The multi-axis industrial robot running trajectory optimization method according to claim 1, characterized in that: The historical data set includes the historical power and historical speed of each axis, the historical power under the same motion posture is the same type of power data, and the historical speed under the same motion posture is the same type of speed data; Analyzing the complexity factor of the motion posture of the multi-axis industrial robot at different target times according to the historical data set specifically includes: Calculate the information entropy of a single axis based on the probability of similar power data and similar speed data of the axis appearing in the historical data set, so as to obtain the information entropy of each axis of the industrial robot under the corresponding machine posture; Calculating the joint entropy between each pair of axes based on similar power data of each pair of axes and similar speed data of each pair of axes, respectively, to obtain the joint entropy of each pair of axes of the industrial robot under the corresponding machine posture, wherein any two axes form a pair of axes; Obtaining a motion posture at a target moment; According to the information entropy and the joint entropy corresponding to the motion posture, the complexity factor of the motion posture at the target moment is calculated to obtain the complexity factors of the motion posture at different target moments.

3. The multi-axis industrial robot running trajectory optimization method according to claim 1, characterized in that: The analyzing the corresponding original vibration signal to obtain the error vibration signal specifically includes: Decomposing the original vibration signal using an ICA algorithm to obtain a plurality of decomposition results, wherein each decomposition result includes a first component signal and a second component signal; Using a polynomial fitting method, the first component signal in each decomposition result is respectively fitted into a function curve to obtain all amplitude type distribution probabilities of the first component signal in each decomposition result; Calculate the kurtosis coefficient and skewness coefficient of the amplitude type distribution of the first component signal in each decomposition result according to all the amplitude type distribution probabilities; Constructing an original vibration signal decomposition function based on the kurtosis coefficient and the skewness coefficient; Based on the original vibration signal decomposition function, the function output values ​​of all decomposition results are calculated to obtain all output values ​​of the original vibration signal decomposition function, and the decomposition result corresponding to the maximum output value is selected as the optimal decomposition result of the original vibration signal, and the second signal component corresponding to the optimal decomposition result is the error vibration signal.

4. The multi-axis industrial robot running trajectory optimization method according to claim 1, characterized in that: The error vibration signal includes a plurality of error vibration component signals; The step of calculating the error vibration intensity coefficient at different target moments according to the error vibration signal and the complexity factor specifically includes: For a target moment, obtain the signal maximum points of all error vibration component signals; Calculate the error vibration delay characteristic factor generated by each signal maximum point; The error vibration intensity coefficient of the vibration error signal at the same target moment is calculated based on the error vibration delay characteristic factor at the same target moment and the corresponding motion posture complexity factor to obtain the error vibration intensity coefficient at different target moments.

5. The multi-axis industrial robot running trajectory optimization method according to claim 1, characterized in that: The calculation of the correction proportional gain component according to the error vibration intensity coefficient at all target moments specifically includes: Normalize the error vibration intensity coefficients of all target moments; The modified proportional gain component is calculated based on the normalized error vibration intensity coefficient and the original proportional gain component.

6. A multi-axis industrial robot trajectory optimization system, characterized in that: The system comprises: An acquisition module, used for real-time acquisition of operation monitoring data of the multi-axis industrial robot at different target times, wherein the operation monitoring data includes an original vibration signal of each axis of the multi-axis industrial robot; An acquisition module, used to acquire a historical data set of the historical operation of the multi-axis industrial robot; A first analysis module, configured to analyze the complexity factor of the motion posture of the multi-axis industrial robot at different target times according to the historical data set; The second analysis module is used to analyze the corresponding original vibration signal at different target moments to obtain an error vibration signal; A first calculation module, used for calculating the error vibration intensity coefficient at different target moments according to the error vibration signal and the complexity factor; A second calculation module is used to calculate a correction proportional gain component according to the error vibration intensity coefficient at all target moments; The optimization module is used to optimize the running trajectory of the robot according to the proportional gain component.

7. The multi-axis industrial robot operation trajectory optimization system according to claim 6, characterized in that: The historical data set includes the historical power and historical speed of each axis, the historical power under the same motion posture is the same type of power data, and the historical speed under the same motion posture is the same type of speed data; The first analysis module specifically includes: A first calculation unit is used to calculate the information entropy of a single axis based on the probability of similar power data and similar speed data of the axis appearing in the historical data set, so as to obtain the information entropy of each axis of the industrial robot under the corresponding machine posture; a second calculation unit, configured to calculate the joint entropy between each pair of axes based on similar power data of each pair of axes and similar speed data of each pair of axes, so as to obtain the joint entropy of each pair of axes of the industrial robot in the corresponding machine posture, wherein any two axes form a pair of axes; A first acquisition unit, used to acquire a motion posture at a target moment; The third calculation unit is used to calculate the complexity factor of the motion posture at the target moment according to the information entropy and the joint entropy corresponding to the motion posture, so as to obtain the complexity factors of the motion posture at different target moments.

8. The multi-axis industrial robot operation trajectory optimization system according to claim 6, characterized in that: The second analysis module specifically includes: A decomposition unit, used for decomposing the original vibration signal by using an ICA algorithm to obtain a plurality of decomposition results, wherein each decomposition result includes a first component signal and a second component signal; A second acquisition unit is used to fit the first component signal in each decomposition result into a function curve using a polynomial fitting method to obtain all amplitude type distribution probabilities of the first component signal in each decomposition result; A fourth calculation unit, used for calculating the kurtosis coefficient and the skewness coefficient of the amplitude type distribution of the first component signal in each decomposition result according to all the amplitude type distribution probabilities; A construction unit, used for constructing an original vibration signal decomposition function based on the kurtosis coefficient and the skewness coefficient; The third acquisition unit is used to calculate the function output values ​​of all decomposition results based on the original vibration signal decomposition function, obtain all output values ​​of the original vibration signal decomposition function, select the decomposition result corresponding to the maximum output value as the optimal decomposition result of the original vibration signal, and the second signal component corresponding to the optimal decomposition result is the error vibration signal.

9. The multi-axis industrial robot operation trajectory optimization system according to claim 6, characterized in that: The error vibration signal includes a plurality of error vibration component signals; The first calculation module specifically includes: A fourth acquisition unit is used to acquire the signal maximum value points of all error vibration component signals at a target moment; A fifth calculation unit, used for calculating the error vibration delay characteristic factor generated by each signal maximum point; The sixth calculation unit is used to calculate the error vibration intensity coefficient of the vibration error signal at the same target moment based on the error vibration delay characteristic factor at the same target moment and the corresponding motion posture complexity factor, so as to obtain the error vibration intensity coefficient at different target moments.

10. The multi-axis industrial robot operation trajectory optimization system according to claim 6, characterized in that: The second calculation module specifically includes: A normalization unit, used for normalizing the error vibration intensity coefficients at all target moments; The seventh calculation unit is used to calculate the modified proportional gain component based on the normalized error vibration intensity coefficient and the original proportional gain component.

Citation Information

Patent Citations

  • Vibration suppression method of flexible mechanical arm based on trajectory segmentation optimization

    CN111046510A

  • Terahertz SAR motion compensation method based on minimum Tsallis entropy algorithm

    CN117607868A

  • Robot control method, robot control apparatus, robot control program, and storage medium

    US20150148956A1

  • Method for planning optimal path having minimum target positioning error of autonomous surface vehicle

    WO2023221658A1

Cited By

  • Assembly robot applied to industrial production line

    CN120307301A

  • Clip-on ammeter with multi-channel interference suppression function

    CN121008212A