Industrial robot control method and system

By monitoring and analyzing the operating status of industrial robot joints in real time, identifying and controlling faulty joints, the problem of failing to detect and address the decline in joint position accuracy in a timely manner in existing technologies is solved, thereby improving the system's operating accuracy and reliability.

CN118789558BActive Publication Date: 2024-11-22FUZHOU UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411267712.X
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-09-11
Publication Date
2024-11-22
Estimated Expiration
2044-09-11

AI Technical Summary

Technical Problem

Existing technologies lack real-time monitoring and dynamic adjustment capabilities, which means that when the joint position accuracy of industrial robots decreases, it cannot be detected and dealt with in a timely manner, affecting system performance and reliability.

Method used

By monitoring the operating status data of industrial robot joints in real time, calculating the mean square error value Mse and comparing it with a preset threshold, faulty joints are identified, fault propagation path analysis is performed, mechanical operation distortion coefficient Jsxs is constructed, and control commands are issued in a timely manner to prevent the spread of faults.

Benefits of technology

It enables efficient and precise fault detection and control of industrial robot joints, improving the system's operational accuracy and reliability, and reducing downtime and maintenance costs.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118789558B_ABST
    Figure CN118789558B_ABST
Patent Text Reader

Abstract

The present invention discloses an industrial robot control method and system, which relates to the technical field of industrial robots. By analyzing the mean square error value Mse between the actual operation set and the standard movement set of each joint, and comparing it with the preset error threshold, it is possible to further accurately judge whether the position accuracy of each joint has a downward trend, thereby ensuring the high-precision operation of the robot. The fault propagation path of the marked faulty joint is analyzed to determine whether there is a fault transmission effect, thereby further improving the comprehensiveness and accuracy of the fault diagnosis. If there is a fault transmission effect, the mechanical wear of the initial faulty joint is estimated through mechanical condition data monitoring to prevent the fault from spreading. Combined with the trained robot kinematic model and related mechanical condition data, the mechanical operation distortion coefficient Jsxs of the initial faulty joint is constructed to further describe the operating state of the faulty joint. If it exceeds the threshold, a control instruction is issued in time, and effective control measures are taken.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of industrial robots, and in particular to an industrial robot control method and system. Background Art

[0002] In the field of industrial automation and intelligent manufacturing, industrial robots perform various complex tasks through pre-set control programs. Specifically, the accuracy and reliability of the control method have a crucial impact on production efficiency and product quality. Especially in the control of each joint of the industrial robot, the position accuracy of each joint of the industrial robot may gradually decrease due to long-term use or mechanical wear and other factors, which not only affects the movement of a single joint, but may also cause the performance of the entire system to deteriorate. Therefore, it is crucial to accurately judge whether each joint has a trend of decreasing position accuracy and identify the initial faulty joints that may cause subsequent joint position accuracy problems, in order to ensure the stability and reliability of the overall operation of the robot.

[0003] In the current field of industrial robot control, traditional methods have certain shortcomings in determining whether the position accuracy of each joint of an industrial robot is decreasing, and how to determine whether the initial faulty joint affects the subsequent joint position accuracy. Existing methods mostly rely on regular maintenance and passive processing after a fault occurs, lacking the ability of real-time monitoring and dynamic adjustment, resulting in joint failures often being discovered only when they have already affected the overall performance of the system. In addition, how to effectively analyze and control the degree of mechanical wear of faulty joints, reduce fault transmission effects, and ensure the continued efficient operation of industrial robot systems is also a technical challenge currently faced. Summary of the invention

[0004] In view of the deficiencies in the prior art, the present invention provides an industrial robot control method and system, which solve the problems in the above-mentioned background technology.

[0005] To achieve the above objectives, the present invention is implemented through the following technical solutions: an industrial robot control method, comprising the following steps:

[0006] S1. Preparation: Obtain the task motion path of the industrial robot in advance, and determine the number of joints of the industrial robot according to the degrees of freedom of the industrial robot. At the same time, record the pre-set motion control data of each joint of the industrial robot and the motion control data of the end effector to construct a standard motion set;

[0007] S2, position analysis: When the industrial robot is in working state, monitor the relevant operating status data of each joint of the industrial robot and the relevant operating status data of the end effector in real time, build the actual operation set, and combine the standard motion set recorded in step S1 to analyze and calculate the motion position coordinates of the end effector and each joint The standard motion position coordinates within the corresponding execution period The mean square error value Mse between them is compared with the preset error threshold to preliminarily determine whether the corresponding joint has a trend of declining position accuracy. If so, the corresponding joint is marked as a faulty joint and a serial number is given;

[0008] S3, fault propagation diagnosis: perform fault propagation path analysis on several groups of faulty joints obtained in step S2 to determine whether there is a fault transmission effect. If so, monitor the relevant mechanical condition data information of the faulty joints that cause the fault transmission effect, and use the faulty joints that cause the fault transmission effect as the initial faulty joints. If not, monitor the relevant mechanical condition data information of each faulty joint to construct a physical change set.

[0009] S4, fault control: Combine the trained robot kinematic model and the relevant mechanical condition data information obtained in step S3 to construct the mechanical operation distortion coefficient Jsxs of the initial faulty joint, and pre-build the control threshold Q. If the mechanical operation distortion coefficient Jsxs of the initial faulty joint exceeds the control threshold Q, a control command is issued to the outside, and control measures are taken for the initial faulty joint;

[0010] S5. Perform fault control on each faulty joint according to the set of physical changes and with reference to the fault control process for the initial faulty joint in step S4.

[0011] Preferably, S11, obtaining the degrees of freedom of the industrial robot according to the type of the industrial robot, determining the number of joints of the industrial robot according to the degrees of freedom, and marking each joint of the industrial robot with a serial number;

[0012] S12. Presetting the motion control state of the industrial robot and the motion control state of the end effector according to the task requirements of the industrial robot to obtain a standard motion set of the industrial robot, wherein the standard motion set includes motion control data of each joint and motion control data of the end effector;

[0013] S121, the motion control data of each joint and the motion control data of the end effector include the standard motion position coordinates of each joint and the end effector in each execution period , speed and acceleration.

[0014] Preferably, S21, when the industrial robot is in working state, the relevant operating state data of each joint of the industrial robot and the relevant operating state data of the end effector are monitored and recorded in real time to construct an actual operation set, wherein the relevant operating state data of each joint of the industrial robot and the relevant operating state data of the end effector include the motion position coordinates of each joint and the end effector in each monitoring period , speed and acceleration;

[0015] S22, according to the motion position coordinates of each joint And standard motion position coordinates , calculate the square error Pse of the end effector and each joint on each coordinate axis respectively, which can be obtained in the following way:

[0016]

[0017]

[0018]

[0019] Where n is the number of joints of the industrial robot, i=1, 2, 3, ..., n, , and They are respectively expressed as the square error of the i-th joint on the x-axis in the j-th monitoring period, the square error of the i-th joint on the y-axis in the j-th monitoring period, and the square error of the i-th joint on the z-axis in the j-th monitoring period;

[0020] S23, according to the square error Pse of the end effector and each joint on each coordinate axis obtained in step S22, calculate the motion position coordinates of each joint The standard motion position coordinates within the corresponding execution period The mean square error value Mse between them can be obtained in the following way:

[0021] .

[0022] Preferably, S24, pre-set an error threshold, and compare and analyze the mean square error value Mse obtained in step S23 with the error threshold to preliminarily determine whether the corresponding joint has a trend of declining position accuracy. The specific determination content is as follows:

[0023] If the mean square error value Mse exceeds the error threshold, it will be preliminarily judged that the position accuracy of the corresponding joint has a downward trend, and the joint will be marked as a faulty joint;

[0024] If the mean square error value Mse does not exceed the error threshold, it will be preliminarily determined that the corresponding joint does not show a trend of declining position accuracy;

[0025] S241. At this time, the faulty joints of the industrial robot are determined according to the determination in step S24, and several groups of faulty joints are marked with serial numbers.

[0026] Preferably, S31, performing fault propagation path analysis on the groups of faulty joints obtained in step S241, and the specific analysis method is as follows:

[0027] S311, monitor and record the time nodes at which the position accuracy of each faulty joint of the industrial robot decreases, and compare the time nodes at which the position accuracy of each faulty joint decreases;

[0028] S312, by extracting the standard motion set and the actual operation set of each faulty joint, and combining the method of obtaining the mean square error value Mse of each joint in step S23, the mean square error value Mse of each faulty joint is obtained, and the correlation coefficient between the mean square error values ​​Mse of each faulty joint is calculated after correlation analysis and dimensionless processing. , which can be obtained by:

[0029]

[0030] In the formula, It is expressed as the mean square error between the motion position coordinates of the i-th fault joint and the standard motion position coordinates in the corresponding execution period, It is expressed as the mean square error between the motion position coordinates of the kth fault joint and the standard motion position coordinates in the corresponding execution period, It is expressed as the mean of the mean square error of the i-th fault joint in the monitoring period, It is expressed as the mean of the mean square error values ​​of the k-th fault joint during the monitoring period.

[0031] Preferably, S313, constructing a correlation matrix Vr between faulty joints to display the correlation between the mean square error values ​​Mse of each faulty joint, which is specifically obtained in the following manner:

[0032]

[0033] Where m represents the number of faulty joints of the factory robot;

[0034] S314, the correlation coefficient between the mean square error values ​​Mse of each fault joint The correlation coefficients are compared with the preset thresholds to determine whether there is a fault transmission effect, that is, whether the initial faulty joint affects the subsequent joint position accuracy. If the correlation coefficient exceeds the preset threshold, it is further determined that there is a fault transmission effect between the corresponding logarithmic fault joints to obtain the initial fault joint and issue a local diagnosis instruction; if the correlation coefficient If the preset threshold is not exceeded, a comprehensive diagnostic instruction is issued.

[0035] Preferably, S41, after receiving the local diagnosis instruction, the relevant mechanical condition data information of the initial faulty joint is monitored, including the torque difference Njcz, the temperature difference Wcv and the joint backlash difference Jbc of the initial faulty joint between each monitoring period;

[0036] S42. After receiving the comprehensive diagnosis instruction, the relevant mechanical condition data information of each faulty joint is monitored, including the torque difference, temperature difference and joint backlash difference of each faulty joint between each monitoring period.

[0037] Preferably, S43, using the relevant mechanical condition data information, combined with the trained robot kinematics model, and after dimensionless processing, the mechanical operation distortion coefficient Jsxs of the initial fault joint is constructed, which is specifically obtained according to the following formula:

[0038]

[0039] In the formula, They are respectively represented as the weight coefficients of the torque difference Njcz, the joint backlash difference Jbc and the temperature difference Wcv, and V is represented as the correction constant.

[0040] Preferably, S44, pre-builds a control threshold Q, and compares and analyzes the mechanical operation distortion coefficient Jsxs of the initial faulty joint with the control threshold Q. If the mechanical operation distortion coefficient Jsxs of the initial faulty joint exceeds the control threshold Q, a control instruction is issued to the outside, and control measures are taken for the initial faulty joint. The specific control contents are as follows: immediately stop the movement of the initial faulty joint to avoid further damage, and adjust the control parameters of the initial faulty joint, and the control parameters include but are not limited to PID gain.

[0041] An industrial robot control system, comprising the following:

[0042] The pre-preparation module obtains the task motion path of the industrial robot in advance, and determines the number of joints of the industrial robot according to the degrees of freedom of the industrial robot. At the same time, the pre-set motion control data of each joint of the industrial robot and the motion control data of the end effector are recorded to construct a standard motion set;

[0043] Position analysis module: When the industrial robot is in working state, it monitors the relevant operating status data of each joint of the industrial robot and the relevant operating status data of the end effector in real time, builds the actual operation set, and combines the standard motion set to analyze and calculate the motion position coordinates of the end effector and each joint. The standard motion position coordinates within the corresponding execution period The mean square error value Mse between them is compared with the preset error threshold to preliminarily determine whether the corresponding joint has a trend of declining position accuracy. If so, the corresponding joint is marked as a faulty joint and a serial number is given;

[0044] The fault propagation diagnosis module analyzes the fault propagation paths of several groups of faulty joints to determine whether there is a fault transmission effect. If so, the faulty joints that cause the fault transmission effect are monitored for relevant mechanical condition data information, and the faulty joints that cause the fault transmission effect are used as the initial faulty joints. If not, the faulty joints are monitored for relevant mechanical condition data information to construct a physical change set.

[0045] The fault control module combines the trained robot kinematic model with the relevant mechanical condition data information to construct the mechanical operation distortion coefficient Jsxs of the initial faulty joint and pre-build the control threshold Q. If the mechanical operation distortion coefficient Jsxs of the initial faulty joint exceeds the control threshold Q, a control command is issued to the outside and control measures are taken on the initial faulty joint;

[0046] The comprehensive control module performs fault control on each faulty joint according to the set of physical changes and with reference to the fault control process for the initial faulty joint in the fault control module.

[0047] The present invention provides an industrial robot control method and system, which have the following beneficial effects:

[0048] (1) By obtaining the task motion path of the industrial robot in advance and determining the number of joints according to the robot's degrees of freedom, a solid foundation is laid for subsequent control and analysis. At the same time, the preset motion control data of each joint and end effector are recorded to form a standard motion set, which is helpful for subsequent error analysis and accuracy judgment. When the robot is in working state, the operating status data of each joint and end effector are monitored in real time, and the actual operation set is constructed to achieve comprehensive monitoring of the robot. By analyzing the mean square error value Mse between the actual operation set and the standard motion set of each joint and comparing it with the preset error threshold, it is possible to further accurately determine whether the position accuracy of each joint has a downward trend, ensuring the high-precision operation of the robot. The fault propagation path of the marked faulty joint is analyzed to determine whether there is a fault transmission effect, which further improves the comprehensiveness and accuracy of fault diagnosis. If there is a fault transmission effect, the mechanical wear of the initial faulty joint can be estimated through mechanical condition data monitoring, which helps to fundamentally solve the fault problem and prevent the fault from spreading. Combined with the trained robot kinematic model and related mechanical condition data, the mechanical operation distortion coefficient Jsxs of the initial faulty joint is constructed to further describe the operating state of the faulty joint. If it exceeds the threshold, a control instruction is issued in time, and effective control measures are taken to quickly solve the fault and ensure the stable operation of the system. If there is no fault transmission effect, the mechanical condition data of each faulty joint is monitored, a set of physical changes is constructed, and the fault control process of the initial faulty joint is referred to, and fault control is performed one by one, further realizing the comprehensive management and control of all faulty joints. In short, this method further realizes the efficient management of each joint of the industrial robot through systematic monitoring, analysis, diagnosis and control steps, effectively improves the operating accuracy, reliability and maintenance efficiency of the robot system, and greatly reduces the downtime and maintenance cost caused by faults.

[0049] (2) By calculating the square error Pse between the motion position coordinates of each joint and end effector in each monitoring period and the standard motion position coordinates, the position error of the joint and end effector on each coordinate axis can be accurately reflected. This precise error calculation method can effectively identify the slight deviations that occur in the motion of each joint and end effector, ensuring the accuracy and reliability of error analysis. By comprehensively calculating the square error Pse of each joint and end effector on each coordinate axis to obtain the mean square error value Mse, the overall position error of each joint and end effector can be fully reflected. This comprehensive error analysis method can effectively evaluate the motion accuracy of each joint and end effector of the robot, and provide a scientific basis for preliminarily judging the downward trend of position accuracy.

[0050] (3) By monitoring and recording the time nodes when the position accuracy of each faulty joint of the industrial robot decreases and comparing these time nodes, the time sequence of the problems of each faulty joint can be accurately determined. This time node recording mechanism helps to trace and locate the initial faulty joint, thereby improving the accuracy and efficiency of fault diagnosis. By constructing the correlation matrix Vr between faulty joints, an intuitive way is provided to understand the relationship and influence between faulty joints, providing a powerful tool for identifying the fault propagation path and the initial faulty joint.

[0051] (4) This method realizes real-time and accurate fault detection and location by real-time monitoring of the operating status data of each joint and end effector of the industrial robot and performing dynamic analysis in combination with a standard motion set. It significantly improves the efficiency and accuracy of fault identification. It not only takes into account the fault detection of a single joint, but also identifies the fault transmission effect through fault propagation path analysis, thereby finding the initial faulty joint that causes the chain failure. This innovative diagnostic method can effectively prevent and control the spread of faults and improve the overall reliability of the system. BRIEF DESCRIPTION OF THE DRAWINGS

[0052] Figure 1 A schematic diagram of steps of an industrial robot control method of the present invention;

[0053] Figure 2 The present invention is a schematic diagram of an industrial robot control system flow chart. DETAILED DESCRIPTION

[0054] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0055] Example 1

[0056] See also Figure 1 The present invention provides an industrial robot control method, comprising the following steps:

[0057] S1. Preparation: Obtain the task motion path of the industrial robot in advance, and determine the number of joints of the industrial robot according to the degrees of freedom of the industrial robot. At the same time, record the pre-set motion control data of each joint of the industrial robot and the motion control data of the end effector to construct a standard motion set;

[0058] S2, position analysis: When the industrial robot is in working state, monitor the relevant operating status data of each joint of the industrial robot and the relevant operating status data of the end effector in real time, build the actual operation set, and combine the standard motion set recorded in step S1 to analyze and calculate the motion position coordinates of the end effector and each joint The standard motion position coordinates within the corresponding execution period The mean square error value Mse between them is compared with the preset error threshold to preliminarily determine whether the corresponding joint has a trend of declining position accuracy. If so, the corresponding joint is marked as a faulty joint and a serial number is given;

[0059] S3, fault propagation diagnosis: perform fault propagation path analysis on several groups of faulty joints obtained in step S2 to determine whether there is a fault transmission effect. If so, monitor the relevant mechanical condition data information of the faulty joints that cause the fault transmission effect, and use the faulty joints that cause the fault transmission effect as the initial faulty joints. If not, monitor the relevant mechanical condition data information of each faulty joint to construct a physical change set.

[0060] S4, fault control: Combine the trained robot kinematic model and the relevant mechanical condition data information obtained in step S3 to construct the mechanical operation distortion coefficient Jsxs of the initial faulty joint, and pre-build the control threshold Q. If the mechanical operation distortion coefficient Jsxs of the initial faulty joint exceeds the control threshold Q, a control command is issued to the outside, and control measures are taken for the initial faulty joint;

[0061] S5. Based on the set of physical changes and referring to the fault control process of the initial faulty joint in step S4, fault control is performed on each faulty joint. This hierarchical diagnostic instruction mechanism improves the efficiency and pertinence of fault handling and ensures that different situations receive the most appropriate handling.

[0062] In this embodiment, the method can preliminarily determine which joints have a trend of decreasing position accuracy by calculating the mean square error value Mse between the actual operation data and the standard motion set, and comparing it with the preset error threshold, so as to achieve early fault warning. Then, by analyzing the fault propagation path of several groups of faulty joints, it can be determined whether there is a fault transmission effect. If there is a fault transmission effect, the initial faulty joint that causes the effect can be identified. By monitoring the mechanical condition data information of the initial faulty joint and other faulty joints, a physical change set is constructed to further analyze the cause and propagation path of the fault. Combined with the trained robot kinematic model, and based on the monitored mechanical condition data information, the mechanical operation distortion coefficient Jsxs of the initial faulty joint is constructed. By setting the control threshold Q and comparing and analyzing Jsxs, control instructions can be issued in time and corresponding control measures can be taken to prevent the fault from further expanding and ensure the normal operation of the robot system. In step S5, according to the physical change set and referring to the fault control process of the initial faulty joint, each faulty joint is controlled one by one to ensure the reliability and stability of the entire system.

[0063] Example 2

[0064] Please refer to Figure 1 Specifically: S11, obtaining the degrees of freedom of the industrial robot according to the type of the industrial robot, determining the number of joints of the industrial robot according to the degrees of freedom, and marking the respective joints of the industrial robot with serial numbers;

[0065] S12. Presetting the motion control state of the industrial robot and the motion control state of the end effector according to the task requirements of the industrial robot to obtain a standard motion set of the industrial robot, wherein the standard motion set includes motion control data of each joint and motion control data of the end effector;

[0066] S121, the motion control data of each joint and the motion control data of the end effector include the standard motion position coordinates of each joint and the end effector in each execution period , speed and acceleration.

[0067] In this embodiment, by obtaining the degrees of freedom according to the type of industrial robot, and determining the number of joints and marking each joint with serial numbers, preparations can be made for the precise management and control of each joint in the later stage. This systematic joint management method can ensure the precise positioning and operation of each joint, thereby improving the accuracy and reliability of the overall system. In step S12, based on the task requirements of the industrial robot, a standard motion set is obtained, and detailed data records are used to provide important benchmark information for subsequent real-time monitoring and analysis, which can help identify and diagnose faults more accurately. At the same time, by comprehensively monitoring the actual motion state of the industrial robot, it is possible to promptly detect and correct abnormal positions in the later stage, further preventing potential faults from expanding and aggravating.

[0068] Example 3

[0069] Please refer to Figure 1 Specifically: S21. When the industrial robot is in working state, the relevant operating state data of each joint of the industrial robot and the relevant operating state data of the end effector are monitored and recorded in real time to construct an actual operation set, wherein the relevant operating state data of each joint of the industrial robot and the relevant operating state data of the end effector include the motion position coordinates of each joint and the end effector in each monitoring period. , speed and acceleration;

[0070] S22, according to the motion position coordinates of each joint And standard motion position coordinates , calculate the square error Pse of the end effector and each joint on each coordinate axis respectively, which can be obtained in the following way:

[0071]

[0072]

[0073]

[0074] Where n is the number of joints of the industrial robot, i=1, 2, 3, ..., n, , and They are respectively expressed as the square error of the i-th joint on the x-axis in the j-th monitoring period, the square error of the i-th joint on the y-axis in the j-th monitoring period, and the square error of the i-th joint on the z-axis in the j-th monitoring period;

[0075] S23, according to the square error Pse of the end effector and each joint on each coordinate axis obtained in step S22, calculate the motion position coordinates of each joint The standard motion position coordinates within the corresponding execution period The mean square error value Mse between them can be obtained in the following way:

[0076] .

[0077] S24, pre-set the error threshold, and compare and analyze the mean square error value Mse obtained in step S23 with the error threshold to preliminarily determine whether the corresponding joint has a trend of declining position accuracy. The specific determination content is as follows:

[0078] If the mean square error value Mse exceeds the error threshold, it will be preliminarily judged that the position accuracy of the corresponding joint has a downward trend, and the joint will be marked as a faulty joint;

[0079] If the mean square error value Mse does not exceed the error threshold, it will be preliminarily determined that the corresponding joint does not show a trend of declining position accuracy;

[0080] S241. At this time, the faulty joints of the industrial robot are determined according to the determination in step S24, and several groups of faulty joints are marked with serial numbers.

[0081] In this embodiment, by real-time monitoring and recording the operating status data of each joint and end effector of the industrial robot, this real-time monitoring mechanism can ensure a comprehensive grasp of the operating status of the industrial robot, provide a reliable data basis for subsequent analysis and judgment, and further enhance the dynamic adaptability and real-time response capability of the system. By calculating the square error Pse between the motion position coordinates and the standard position coordinates of each joint and end effector in each monitoring period, the position error on each coordinate axis can be refined and quantified. This precise calculation method can reflect the deviation between the motion trajectory of each joint and end effector and the standard trajectory in more detail. In step S23, the mean square error value Mse between the motion position coordinates of each joint and the standard motion position coordinates is calculated according to the square error Pse, further realizing a comprehensive evaluation of the position error. The mean square error value Mse can effectively integrate the error data in each period, provide a reliable basis for judging the downward trend of position accuracy, and improve the scientificity and integrity of error analysis. And by comparing and analyzing the mean square error value Mse with the error threshold, it is possible to quickly and accurately determine whether there is a downward trend in position accuracy, effectively distinguish normal error fluctuations and potential faults, ensure accurate fault diagnosis, and improve the sensitivity and reliability of fault detection. In step S241, according to the comparison results, the joints showing a downward trend in position accuracy are marked and serially marked, which helps the system to quickly identify and subsequently process the faulty joints. The serial number marking of the faulty joint provides a clear target for the subsequent fault propagation diagnosis and control, and improves the efficiency and accuracy of fault handling. Through the above series of steps, a complete process of real-time monitoring, precise analysis, judgment and marking is constructed, which can timely detect and locate the potential faults of various joints of the industrial robot. This systematic method can not only improve the stability and reliability of the industrial robot in a complex working environment, but also further extend its service life and reduce downtime and maintenance costs caused by faults. In short, this method further improves the position accuracy analysis and fault detection capabilities of various joints and end effectors of the industrial robot through real-time monitoring, precise calculation and systematic fault diagnosis methods, so as to better meet the needs of high-precision and high-reliability robot control in industrial production.

[0082] Example 4

[0083] Please refer to Figure 1 Specifically: S31, performing fault propagation path analysis on several groups of faulty joints obtained in step S241, the specific analysis method is as follows:

[0084] S311, monitor and record the time nodes at which the position accuracy of each faulty joint of the industrial robot decreases, and compare the time nodes at which the position accuracy of each faulty joint decreases;

[0085] S312, by extracting the standard motion set and the actual operation set of each faulty joint, and combining the method of obtaining the mean square error value Mse of each joint in step S23, the mean square error value Mse of each faulty joint is obtained, and the correlation coefficient between the mean square error values ​​Mse of each faulty joint is calculated after correlation analysis and dimensionless processing. , which can be obtained by:

[0086]

[0087] In the formula, It is expressed as the mean square error between the motion position coordinates of the i-th fault joint and the standard motion position coordinates in the corresponding execution period, It is expressed as the mean square error between the motion position coordinates of the kth fault joint and the standard motion position coordinates in the corresponding execution period, It is expressed as the mean of the mean square error of the i-th fault joint in the monitoring period, It is expressed as the mean of the mean square error values ​​of the k-th fault joint during the monitoring period.

[0088] S313, constructing a correlation matrix Vr between faulty joints to show the correlation between the mean square error values ​​Mse of each faulty joint, which is specifically obtained in the following manner:

[0089]

[0090] Where m represents the number of faulty joints of the factory robot; and n ≥ m.

[0091] S314, the correlation coefficient between the mean square error values ​​Mse of each fault joint The correlation coefficients are compared with the preset thresholds to determine whether there is a fault transmission effect, that is, whether the initial faulty joint affects the subsequent joint position accuracy. If the correlation coefficient exceeds the preset threshold, it is further determined that there is a fault transmission effect between the corresponding logarithmic fault joints to obtain the initial fault joint and issue a local diagnosis instruction; if the correlation coefficient If the preset threshold is not exceeded, a comprehensive diagnostic instruction is issued.

[0092] In this embodiment, by performing fault propagation path analysis on several groups of faulty joints, it is first necessary to identify and record the time nodes at which the position accuracy of each faulty joint decreases. This precise time node recording method can help quickly locate the order of fault occurrence and provide accurate data support for fault propagation path analysis. In step S312, the correlation coefficient between each pair of faulty joints can be obtained through the mean square error value Mse of each pair of faulty joints. , in order to effectively evaluate the correlation between faulty joints and provide a scientific basis for judging the fault propagation path; and by constructing the correlation matrix Vr between faulty joints, the correlation between the mean square error values ​​Mse of each pair of faulty joints can be intuitively displayed. This matrixed correlation analysis method can comprehensively display the correlation between faulty joints, and is helpful to quickly identify joints that may have fault transmission effects. Through layer-by-layer analysis, the initial faulty joint is finally identified, further ensuring effective monitoring and control of the joints that cause the fault transmission effect. Accurate identification of the initial faulty joint helps to take targeted fault control measures in a timely manner to prevent the further spread of the fault and ensure the stable operation of the industrial robot system. In step S314, according to the correlation coefficient The comparison results can flexibly switch to issue local diagnostic instructions or comprehensive diagnostic instructions. If there is a fault transmission effect, a local diagnostic instruction can be issued to perform detailed analysis and processing on the initial faulty joint; if there is no transmission effect, a comprehensive diagnostic instruction can be issued to conduct a comprehensive inspection of all faulty joints. This flexible diagnostic instruction switching mechanism can effectively improve the efficiency of fault diagnosis and processing. In the overall steps, the fault diagnosis and processing efficiency of the industrial robot system can be significantly improved through precise fault propagation path analysis, correlation analysis of mean square error values, construction of correlation matrix, and preset threshold comparison analysis. This systematic method can timely detect and process faulty joints, prevent further spread of faults, and ensure efficient and stable operation of the industrial robot system.

[0093] Example 5

[0094] Please refer to Figure 1 Specifically: S41, after receiving the local diagnosis instruction, the relevant mechanical condition data information of the initial fault joint is monitored, including the torque difference Njcz, temperature difference Wcv and joint backlash difference Jbc of the initial fault joint between each monitoring period;

[0095] S42. After receiving the comprehensive diagnosis instruction, the relevant mechanical condition data information of each faulty joint is monitored, including the torque difference, temperature difference and joint backlash difference of each faulty joint between each monitoring period.

[0096] A convolutional neural network is used to build an initial model, which is then trained and tested with relevant mechanical condition data information. The trained initial model is used as a state recognition model, and feature information therein is obtained. The state recognition model is trained and tested with the acquired feature information. The trained state recognition model is then used as a robot kinematic model in combination with the corresponding diagnostic instructions received.

[0097] S43. Using the relevant mechanical condition data information, combined with the trained robot kinematics model, and after dimensionless processing, the mechanical operation distortion coefficient Jsxs of the initial faulty joint is constructed, which is specifically obtained according to the following formula:

[0098]

[0099] In the formula, They are respectively expressed as the weight coefficients of torque difference Njcz, joint backlash difference Jbc and temperature difference Wcv, where 0< ≤1,0< ≤1,0< ≤1, and =1, V represents the correction constant, and the weight coefficient can be obtained by referring to the hierarchical analysis method;

[0100] The torque difference Njcz is monitored and obtained by a torque sensor installed on the joint shaft. The torque sensor model can be HBM T40B series.

[0101] The joint backlash difference Jbc can be monitored and obtained through a displacement sensor. The backlash difference is evaluated by measuring the displacement change of the joint when it is subjected to torque. The displacement sensor model can be Keyence IL series.

[0102] The temperature difference Wcv can be monitored and obtained by a temperature sensor, wherein the temperature sensor model can use an Omega K-type thermocouple;

[0103] It should be noted that the hierarchical analysis method is a combination of qualitative and quantitative analysis methods. It can decompose complex problems into multiple levels. By comparing the importance of factors at each level, it can help decision makers make decisions on complex issues and determine the final decision plan. In this process, the hierarchical analysis method can be used to determine the weight coefficients of these indicators.

[0104] In this embodiment, after receiving a local diagnosis instruction or a comprehensive diagnosis instruction, the initial faulty joint or each faulty joint is monitored for detailed mechanical condition data information, so that the mechanical operation status and performance changes of the faulty joint can be understood in many aspects. By constructing the mechanical operation distortion coefficient Jsxs of the initial faulty joint, the degree of influence of the mechanical operation distortion on the current faulty joint can be reflected. Through dimensionless processing, the comparability of data and the accuracy of analysis are further ensured, providing a scientific basis for subsequent fault control.

[0105] Example 6

[0106] Please refer to Figure 1Specifically: S44, pre-build the control threshold Q, and compare and analyze the mechanical operation distortion coefficient Jsxs of the initial fault joint with the control threshold Q. If the mechanical operation distortion coefficient Jsxs of the initial fault joint exceeds the control threshold Q, a control instruction is issued to the outside, and control measures are taken for the initial fault joint. The specific control content is as follows: immediately stop the movement of the initial fault joint to avoid further damage, and adjust the control parameters of the initial fault joint. The control parameters include but are not limited to PID gains to improve the control accuracy and response speed of the joint. At the same time, lubricate and maintain the initial fault joint to reduce friction and wear. If the initial fault joint fails seriously, switch to the spare joint and reallocate tasks to ensure the continuous operation of the system.

[0107] In this embodiment, by comparing and analyzing the mechanical operation distortion coefficient Jsxs with the preset control threshold Q, the system can quickly determine the health status of the initial fault joint. When it exceeds the control threshold Q, the system immediately issues a control instruction and takes necessary control measures to protect the joint and prevent further damage. For the faulty joint, the system immediately stops its movement to avoid situations that may cause more serious damage. This measure effectively protects other components of the mechanical system and the overall operation stability. The system adjusts the control parameters of the initial fault joint according to the situation, including PID gain, etc., to improve the control accuracy and response speed of the joint. By optimizing the control parameters, the system can more accurately control the movement of the joint, reduce position error and response delay. Lubrication maintenance of the initial fault joint is aimed at reducing friction and wear, thereby extending the service life of the joint and improving operation efficiency. Good lubrication conditions help reduce mechanical wear, reduce fault frequency and maintenance costs. If the fault of the initial fault joint is serious or cannot be repaired in time, the system can automatically switch to the spare joint and reallocate tasks to ensure the continuous operation and production efficiency of the industrial robot system and minimize production interruption time. The implementation of the above control measures effectively guarantees the continuous operation and production stability of the industrial robot system. Through timely fault diagnosis and precise control response, the system can respond quickly when a fault occurs, and minimize downtime and production losses through reasonable control measures. In summary, the control strategies and measures in step S44 greatly improve the reliability and stability of the industrial robot system. Through intelligent fault control and maintenance means, the system can effectively prevent and respond to joint failures, ensure the long-term and efficient operation of the mechanical system, and provide reliable protection for production.

[0108] Example 7

[0109] Please refer to Figure 1 and Figure 2 , specifically: an industrial robot control system, including the following contents,

[0110] The pre-preparation module obtains the task motion path of the industrial robot in advance, and determines the number of joints of the industrial robot according to the degrees of freedom of the industrial robot. At the same time, the pre-set motion control data of each joint of the industrial robot and the motion control data of the end effector are recorded to construct a standard motion set;

[0111] Position analysis module: When the industrial robot is in working state, it monitors the relevant operating status data of each joint of the industrial robot and the relevant operating status data of the end effector in real time, builds the actual operation set, and combines the standard motion set to analyze and calculate the motion position coordinates of the end effector and each joint. The standard motion position coordinates within the corresponding execution period The mean square error value Mse between them is compared with the preset error threshold to preliminarily determine whether the corresponding joint has a trend of declining position accuracy. If so, the corresponding joint is marked as a faulty joint and a serial number is given;

[0112] The fault propagation diagnosis module analyzes the fault propagation paths of several groups of faulty joints to determine whether there is a fault transmission effect. If so, the faulty joints that cause the fault transmission effect are monitored for relevant mechanical condition data information, and the faulty joints that cause the fault transmission effect are used as the initial faulty joints. If not, the faulty joints are monitored for relevant mechanical condition data information to construct a physical change set.

[0113] The fault control module combines the trained robot kinematic model with the relevant mechanical condition data information to construct the mechanical operation distortion coefficient Jsxs of the initial faulty joint and pre-build the control threshold Q. If the mechanical operation distortion coefficient Jsxs of the initial faulty joint exceeds the control threshold Q, a control command is issued to the outside and control measures are taken on the initial faulty joint;

[0114] The comprehensive control module performs fault control on each faulty joint according to the set of physical changes and with reference to the fault control process for the initial faulty joint in the fault control module.

[0115] Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the appended claims and their equivalents.

Claims

1. A method for controlling an industrial robot, Features: The following steps are involved: S1. Preparation: Obtain the task motion path of the industrial robot in advance, and determine the number of joints of the industrial robot according to the degrees of freedom of the industrial robot. At the same time, record the pre-set motion control data of each joint of the industrial robot and the motion control data of the end effector to construct a standard motion set; S2, position analysis: When the industrial robot is in working state, monitor the relevant operating status data of each joint of the industrial robot and the relevant operating status data of the end effector in real time, build the actual operation set, and combine the standard motion set recorded in step S1 to analyze and calculate the motion position coordinates of the end effector and each joint The standard motion position coordinates within the corresponding execution period The mean square error value Mse between them is compared with the preset error threshold to preliminarily determine whether the corresponding joint has a trend of declining position accuracy. If so, the corresponding joint is marked as a faulty joint and a serial number is given; where i represents the joint serial number and j represents the monitoring period serial number; S3, fault propagation diagnosis: perform fault propagation path analysis on several groups of faulty joints obtained in step S2 to determine whether there is a fault transmission effect. If so, monitor the relevant mechanical condition data information of the faulty joints that cause the fault transmission effect, and use the faulty joints that cause the fault transmission effect as the initial faulty joints. If not, monitor the relevant mechanical condition data information of each faulty joint to construct a physical change set. S4, fault control: Combine the trained robot kinematic model and the relevant mechanical condition data information obtained in step S3 to construct the mechanical operation distortion coefficient Jsxs of the initial faulty joint, and pre-build the control threshold Q. If the mechanical operation distortion coefficient Jsxs of the initial faulty joint exceeds the control threshold Q, a control command is issued to the outside, and control measures are taken for the initial faulty joint; S5. Perform fault control on each faulty joint according to the set of physical changes and with reference to the fault control process for the initial faulty joint in step S4.

2. An industrial robot control method according to claim 1, Features: S11. Obtain the degrees of freedom of the industrial robot according to the type of the industrial robot, determine the number of joints of the industrial robot according to the degrees of freedom, and mark each joint of the industrial robot with a serial number; S12. Presetting the motion control state of the industrial robot and the motion control state of the end effector according to the task requirements of the industrial robot to obtain a standard motion set of the industrial robot, wherein the standard motion set includes motion control data of each joint and motion control data of the end effector; S121, the motion control data of each joint and the motion control data of the end effector include the standard motion position coordinates of each joint and the end effector in each execution period , speed and acceleration.

3. An industrial robot control method according to claim 2, Features: S21. When the industrial robot is in working state, the relevant operating status data of each joint of the industrial robot and the relevant operating status data of the end effector are monitored and recorded in real time to construct an actual operation set, wherein the relevant operating status data of each joint of the industrial robot and the relevant operating status data of the end effector include the motion position coordinates of each joint and the end effector in each monitoring period , speed and acceleration; S22, according to the motion position coordinates of each joint And standard motion position coordinates , calculate the square error Pse of the end effector and each joint on each coordinate axis respectively, which can be obtained in the following way: ; ; ; Where n is the number of joints of the industrial robot, i=1, 2, 3, ..., n, , and They are respectively expressed as the square error of the i-th joint on the x-axis in the j-th monitoring period, the square error of the i-th joint on the y-axis in the j-th monitoring period, and the square error of the i-th joint on the z-axis in the j-th monitoring period; S23, according to the square error Pse of the end effector and each joint on each coordinate axis obtained in step S22, calculate the motion position coordinates of each joint The standard motion position coordinates within the corresponding execution period The mean square error value Mse between them can be obtained in the following way: 。 4. An industrial robot control method according to claim 3, Features: S24, pre-set the error threshold, and compare and analyze the mean square error value Mse obtained in step S23 with the error threshold to preliminarily determine whether the position accuracy of the corresponding joint has a downward trend. The specific determination content is as follows: If the mean square error value Mse exceeds the error threshold, it will be preliminarily judged that the position accuracy of the corresponding joint has a downward trend, and the joint will be marked as a faulty joint; If the mean square error value Mse does not exceed the error threshold, it will be preliminarily determined that the corresponding joint does not show a trend of declining position accuracy; S241. At this time, the faulty joints of the industrial robot are determined according to the determination in step S24, and several groups of faulty joints are marked with serial numbers.

5. An industrial robot control method according to claim 4, Features: S31, performing fault propagation path analysis on the several groups of faulty joints obtained in step S241, and the specific analysis method is as follows: S311, monitor and record the time nodes at which the position accuracy of each faulty joint of the industrial robot decreases, and compare the time nodes at which the position accuracy of each faulty joint decreases; S312, by extracting the standard motion set and the actual operation set of each faulty joint, and combining the method of obtaining the mean square error value Mse of each joint in step S23, the mean square error value Mse of each faulty joint is obtained, and the correlation coefficient between the mean square error values ​​Mse of each faulty joint is calculated after correlation analysis and dimensionless processing. , which can be obtained by: ; In the formula, It is expressed as the mean square error between the motion position coordinates of the i-th fault joint and the standard motion position coordinates in the corresponding execution period, It is expressed as the mean square error between the motion position coordinates of the kth fault joint and the standard motion position coordinates in the corresponding execution period, It is expressed as the mean of the mean square error of the i-th fault joint in the monitoring period, It is expressed as the mean of the mean square error values ​​of the k-th fault joint during the monitoring period.

6. An industrial robot control method according to claim 5, Features: S313, constructing a correlation matrix Vr between faulty joints to show the correlation between the mean square error values ​​Mse of each faulty joint, which is specifically obtained in the following manner: ; Where m represents the number of faulty joints of the factory robot; S314, the correlation coefficient between the mean square error values ​​Mse of each fault joint The correlation coefficients are compared with the preset thresholds to determine whether there is a fault transmission effect, that is, whether the initial faulty joint affects the subsequent joint position accuracy. If the correlation coefficient exceeds the preset threshold, it is further determined that there is a fault transmission effect between the corresponding logarithmic fault joints to obtain the initial fault joint and issue a local diagnosis instruction; if the correlation coefficient If the preset threshold is not exceeded, a comprehensive diagnostic instruction is issued.

7. An industrial robot control method according to claim 6, Features: S41, after receiving the local diagnosis instruction, monitoring the relevant mechanical condition data information of the initial faulty joint, including the torque difference Njcz, temperature difference Wcv and joint backlash difference Jbc of the initial faulty joint between each monitoring period; S42. After receiving the comprehensive diagnosis instruction, the relevant mechanical condition data information of each faulty joint is monitored, including the torque difference, temperature difference and joint backlash difference of each faulty joint between each monitoring period.

8. An industrial robot control method according to claim 7, Features: S43. Using the relevant mechanical condition data information, combined with the trained robot kinematics model, and after dimensionless processing, the mechanical operation distortion coefficient Jsxs of the initial faulty joint is constructed, which is specifically obtained according to the following formula: ; In the formula, They are respectively represented as the weight coefficients of the torque difference Njcz, the joint backlash difference Jbc and the temperature difference Wcv, and V is represented as the correction constant.

9. An industrial robot control method according to claim 8, Features: S44. Pre-build the control threshold Q, and compare and analyze the mechanical operation distortion coefficient Jsxs of the initial faulty joint with the control threshold Q. If the mechanical operation distortion coefficient Jsxs of the initial faulty joint exceeds the control threshold Q, a control instruction is issued to the outside, and control measures are taken for the initial faulty joint. The specific control contents are as follows: immediately stop the movement of the initial faulty joint to avoid further damage, and adjust the control parameters of the initial faulty joint. The control parameters include but are not limited to PID gain.

10. An industrial robot control system, applying an industrial robot control method according to any one of claims 1 to 9, Features: Include the following: The pre-preparation module obtains the task motion path of the industrial robot in advance, and determines the number of joints of the industrial robot according to the degrees of freedom of the industrial robot. At the same time, the pre-set motion control data of each joint of the industrial robot and the motion control data of the end effector are recorded to construct a standard motion set; Position analysis module: When the industrial robot is in working state, it monitors the relevant operating status data of each joint of the industrial robot and the relevant operating status data of the end effector in real time, builds the actual operation set, and combines the standard motion set to analyze and calculate the motion position coordinates of the end effector and each joint. The standard motion position coordinates within the corresponding execution period The mean square error value Mse between them is compared with the preset error threshold to preliminarily determine whether the corresponding joint has a trend of declining position accuracy. If so, the corresponding joint is marked as a faulty joint and a serial number is given; where i represents the joint serial number and j represents the monitoring period serial number; The fault propagation diagnosis module analyzes the fault propagation paths of several groups of faulty joints to determine whether there is a fault transmission effect. If so, the faulty joints that cause the fault transmission effect are monitored for relevant mechanical condition data information, and the faulty joints that cause the fault transmission effect are used as the initial faulty joints. If not, the faulty joints are monitored for relevant mechanical condition data information to construct a physical change set. The fault control module combines the trained robot kinematic model with the relevant mechanical condition data information to construct the mechanical operation distortion coefficient Jsxs of the initial faulty joint and pre-build the control threshold Q. If the mechanical operation distortion coefficient Jsxs of the initial faulty joint exceeds the control threshold Q, a control command is issued to the outside and control measures are taken on the initial faulty joint; The comprehensive control module performs fault control on each faulty joint according to the set of physical changes and with reference to the fault control process for the initial faulty joint in the fault control module.