An event-triggered fault-tolerant control method for a robotic arm system
Through fault detection, dynamic control strategy adjustment and safety detection, the problem of unstable operation of intelligent robot robot arm in failure situations is solved, the control accuracy and robustness are improved, and the safe operation of the robot arm in complex environments is ensured.
Patent Information
- Application Number
- CN202411345606.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-26
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2044-09-26
AI Technical Summary
The operating status of the intelligent robot's robot arm differs from the preset trajectory in the event of a failure, resulting in unstable operation and reducing the control accuracy of the event-triggered fault-tolerant control method.
By obtaining data from the intelligent robot robot arm, it can detect faults, analyze and match fault adjustment rules, use fuzzy control algorithms and genetic algorithms to dynamically adjust control strategies, optimize motion trajectory, monitor and perform safety inspections in real time, and ensure that the robot arm is in a fault situation Stable operation.
It improves the operating stability and control accuracy of the robotic arm, enhances the robustness and safety of the system, and realizes closed-loop control to adapt to complex environments and task requirements.
Smart Images

Figure CN118848995B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of intelligent robot mechanical arm control and regulation, and in particular to an event-triggered fault-tolerant control method for a mechanical arm system. Background Art
[0002] The robotic arm system of an intelligent robot consists of several key parts: mechanical structure, sensors, actuators, control systems, and software algorithms. The robotic arm system is responsible for collecting environmental information such as position, force, and temperature through sensors so that the robotic arm can accurately sense its surroundings. The actuator is the power source of the robotic arm, enabling the robotic arm to move according to the instructions of the control system. The control system is the brain of the robotic arm. The control system is the robotic arm that receives input signals from sensors and directs the actuators to perform precise movements based on preset algorithms or real-time decisions. The software algorithm is responsible for processing data, planning movement trajectories, and optimizing the performance of the robotic arm.
[0003] The robotic arm system of the intelligent robot has multiple functions, including precise motion control, object grasping and placement, and environmental perception, which makes the robotic arm have a wide range of application value in industrial production and other fields. In industrial production, the robotic arm can automatically complete tasks such as assembly, welding and packaging, improving production efficiency and quality.
[0004] The event-triggered fault-tolerant control method of the robotic arm system is an advanced control strategy designed to improve the stability and reliability of the robotic arm when failures or abnormal situations occur. The event-triggered fault-tolerant control method of the robotic arm system combines the event-triggered mechanism and fault-tolerant control technology to reduce unnecessary communication burden and improve the real-time and robustness of the system.
[0005] The event-triggered fault-tolerant control method for the robotic arm system has the following technical pain points in actual use: the running state of the robotic arm of the intelligent robot differs from the preset trajectory in the event of a fault, resulting in unstable operation of the robotic arm of the intelligent robot, and causing the control accuracy of the robotic arm by the event-triggered fault-tolerant control method of the robotic arm system to decrease. To this end, the present invention provides an event-triggered fault-tolerant control method for a robotic arm system, which is used to improve the running stability of the robotic arm of the intelligent robot in the event of a fault. Summary of the invention
[0006] In view of the shortcomings of the prior art, the present invention provides an event-triggered fault-tolerant control method for a robotic arm system to solve the problem that the operating state of the robotic arm of an intelligent robot differs from a preset trajectory in the event of a fault, resulting in unstable operation of the robotic arm of the intelligent robot and a decrease in the control accuracy of the robotic arm by the event-triggered fault-tolerant control method of the robotic arm system.
[0007] In order to solve the above technical problems, the specific technical solutions of the present invention are as follows:
[0008] The present invention provides an event-triggered fault-tolerant control method for a robotic arm system, comprising:
[0009] Step S101, obtaining intelligent robot mechanical arm data and mechanical arm preset motion trajectory data, the intelligent robot mechanical arm data including mechanical arm motion data, sensor data, control system data, electrical system data and communication system data, performing fault detection on the intelligent robot mechanical arm data to obtain a fault detection result of the intelligent robot mechanical arm data;
[0010] Step S102, analyzing the fault detection result of the intelligent robot manipulator data to obtain manipulator arm fault data, matching the manipulator arm fault data in a preset fault adjustment rule library to obtain a manipulator arm control strategy corresponding to the fault, and executing the manipulator arm control strategy corresponding to the fault;
[0011] Step S103, obtaining real-time intelligent robot mechanical arm data after executing the mechanical arm control strategy corresponding to the fault, comparing the real-time intelligent robot mechanical arm data with the preset mechanical arm motion trajectory data, obtaining real-time intelligent robot mechanical arm operation error data, retrieving intelligent robot mechanical arm historical data, real-time intelligent robot mechanical arm data and real-time intelligent robot mechanical arm operation error data and substituting them into a preset mechanical arm error analysis model, and obtaining a mechanical arm error analysis result;
[0012] Step S104, based on the robot arm error analysis result, dynamically adjust the robot arm control strategy through the fuzzy control algorithm, generate the robot arm motion trajectory command, optimize the robot arm motion trajectory command, and the optimized robot arm motion trajectory command is used to adjust the motion trajectory of the robot arm;
[0013] Step S105, collect the robot arm operation data after the robot arm executes the optimized robot arm motion trajectory command, obtain the robot arm adjustment operation data, perform safety detection and analysis on the robot arm adjustment operation data, and obtain the robot arm adjustment operation safety detection result. If there is a safety risk in the robot arm adjustment operation safety detection result, execute the robot arm control strategy corresponding to the fault adjustment rule matching result.
[0014] Furthermore, the event-triggered fault-tolerant control method of the robotic arm system provided by the present invention, step S101, comprises:
[0015] Pre-loading preset motion trajectory data of the robot arm, the preset motion trajectory data including a predetermined path and motion parameters;
[0016] Real-time monitoring of data mutations or values beyond a predetermined range in the intelligent robot's mechanical arm data and the mechanical arm's preset motion trajectory data;
[0017] When a data mutation or a value outside a predetermined range is detected, abnormal information of the intelligent robot arm is generated.
[0018] Furthermore, the event-triggered fault-tolerant control method of the robotic arm system provided by the present invention, step S102 includes:
[0019] The server establishes a fault adjustment rule base, which includes fault causes and solution information corresponding to the fault mode;
[0020] The parsed fault data needs to be matched with the data in the fault adjustment rule library. After the match is successful, the corresponding fault adjustment rule is extracted from the database as the fault adjustment rule matching result;
[0021] The fault adjustment rule matching result includes adjusting the motion trajectory, speed, and acceleration of the robotic arm. The corresponding fault adjustment rule will be extracted from the database and sent to the robotic arm system to obtain the fault adjustment feedback data of the robotic arm.
[0022] Furthermore, the event-triggered fault-tolerant control method of the robotic arm system provided by the present invention, step S103 includes:
[0023] Copying the real-time intelligent robot manipulator data after executing the manipulator control strategy corresponding to the fault to obtain first data to be compared and second data to be compared;
[0024] Decomposing the preset motion trajectory data of the robot arm to obtain segmented data of the preset motion trajectory of the robot arm after the task decomposition, and generating time information corresponding to the segmented data according to the decomposed segmented data of the preset motion trajectory of the robot arm;
[0025] According to the time information corresponding to the segmented data, the preset motion trajectory of the robot arm is matched to obtain the time segmented motion trajectory of the robot arm.
[0026] Comparing the first data to be compared with the preset motion trajectory segment data of the robot arm to obtain a first error comparison result;
[0027] The second data to be compared is compared with the time segmented robot arm motion trajectory to obtain a second error comparison result.
[0028] Furthermore, the event-triggered fault-tolerant control method of the robotic arm system provided by the present invention, step S103 includes:
[0029] Retrieving the preset robot arm movement trajectory in the preset robot arm movement trajectory segmented data after task decomposition, comparing the actual robot arm movement trajectory in the first to-be-compared data with the preset robot arm movement trajectory, and obtaining an error value between the actual robot arm movement trajectory in each segmented data and the expected movement trajectory after task decomposition;
[0030] Retrieving the preset robot arm movement trajectory in the time segment robot arm movement trajectory, comparing the actual movement trajectory of the robot arm in the second to-be-compared data with the time segment robot arm movement trajectory, and obtaining an error value between the time segment robot arm movement trajectory and the expected movement trajectory after task decomposition;
[0031] The error values between the actual motion trajectory of the robot arm in each segmented data and the expected motion trajectory after task decomposition, as well as the error values between the motion trajectory of the robot arm in the time segment and the expected motion trajectory after task decomposition, are summarized to obtain the real-time intelligent robot robot arm operation error data.
[0032] Furthermore, the event-triggered fault-tolerant control method of the robotic arm system provided by the present invention, step S104 comprises:
[0033] The error analysis result is used as the input of the fuzzy controller, and fuzzy reasoning is performed through the fuzzy control algorithm. According to the preset fuzzy rules, the adjustment value of the output control quantity is obtained, and the adjustment value of the control quantity is used to dynamically adjust the error analysis result of the robot arm. The dynamic adjustment of the error analysis result of the robot arm includes adjusting the parameters of the PID controller, changing the movement speed or acceleration of the robot arm, and obtaining the adjusted robot arm control strategy;
[0034] Based on the adjusted robot arm control strategy, the preset motion trajectory data of the robot arm is recalculated and an adjusted robot arm motion trajectory command is generated. The adjusted robot arm motion trajectory command includes the robot arm moving position, the robot arm moving speed, the robot arm moving acceleration, and the coordinated motion instructions of each joint of the robot arm;
[0035] Real-time monitoring of the motion data of the robot arm when it executes the adjusted robot arm motion trajectory command;
[0036] The motion data of the adjusted robot arm motion trajectory command is compared with the adjusted robot arm motion trajectory command to obtain the adjusted robot arm operation error data, and the adjusted robot arm operation error data is compared with the preset robot arm motion trajectory error value. If in the comparison result, the adjusted robot arm operation error data exceeds the preset robot arm motion trajectory error value, the adjusted robot arm control strategy is optimized using a genetic algorithm to obtain an optimized adjustment strategy.
[0037] Furthermore, the event-triggered fault-tolerant control method of the robotic arm system provided by the present invention, step S104 comprises:
[0038] Determine the population of the genetic algorithm and set the termination condition of the genetic algorithm, which includes the maximum number of iterations or the fitness threshold;
[0039] Encoding the parameters of the robot control strategy as genes of the genetic algorithm, the parameters of the robot control strategy including the parameters of the PID controller and the movement speed or acceleration of the robot;
[0040] Construct an initial population and randomly generate a set of initial robot arm control strategies;
[0041] For each robot control strategy in the population, a fitness function is used to quantify the performance of each robot control strategy to obtain the value of the fitness function, and each robot control strategy includes a combination of accuracy, stability, and response time indicators of the robot motion trajectory;
[0042] According to the value of the fitness function, individuals with better performance of the robot arm control strategy are selected to enter the next generation;
[0043] Randomly pair the selected robot arm control strategies and perform crossover operations to generate new robot arm control strategies;
[0044] Perform mutation operation on the newly generated robot arm control strategy to obtain a newly added robot arm control strategy population;
[0045] Add the newly added robot arm control strategy population to the next generation population;
[0046] After reaching the termination condition of the genetic algorithm, the robot control strategy with the highest fitness is selected as the optimal solution;
[0047] The optimal solution is decoded into the parameters of the robot control strategy to obtain the optimized adjustment strategy.
[0048] Furthermore, the event-triggered fault-tolerant control method of the robotic arm system provided by the present invention, step S105, comprises:
[0049] Use the preset safety detection algorithm to analyze the operation data of the robot arm after adjustment to obtain the robot arm's motion range detection results, robot arm abnormal torque detection results, and robot arm speed fluctuation detection results;
[0050] If the robot arm's motion range detection result, the robot arm's abnormal torque detection result, and the robot arm's speed fluctuation detection result are within the preset safety range value, the robot arm's operating status continues to be monitored;
[0051] If the robot arm's motion range detection result, the robot arm's abnormal torque detection result, and the robot arm's speed fluctuation detection result are not within the preset safety range value, a robot arm safety warning information is generated.
[0052] Beneficial effects of the present invention:
[0053] Improve the operational stability of the robotic arm: Real-time monitoring and fault detection mechanisms enable the robotic arm to respond and adjust quickly when a fault or abnormal situation occurs, thereby effectively improving operational stability.
[0054] Improve control accuracy: By comparing real-time data with preset trajectories and dynamically adjusting control strategies using error analysis models and fuzzy control algorithms, the present invention can reduce the difference between the actual operating trajectory and the preset trajectory and improve control accuracy.
[0055] Enhanced system robustness: The event trigger mechanism reduces the communication burden, making the control system more robust in complex environments and better adaptable to various working conditions and task requirements.
[0056] Realize intelligent optimization: When the operating error exceeds the preset range, the genetic algorithm is used to further optimize the control strategy, and the optimal solution is found through intelligent algorithm iteration to improve the performance and stability of the robot arm.
[0057] Improve system safety: Safety detection and analysis can timely detect and respond to potential safety risks, ensuring the safe operation of the robotic arm in complex environments.
[0058] Provide closed-loop control: A closed-loop control system is constructed through real-time monitoring, fault detection, dynamic adjustment, safety detection and intelligent optimization. The control strategy is adjusted in real time according to the operating status to ensure the optimal operation of the robotic arm.
[0059] In general, the present invention significantly improves the performance of the robotic arm in terms of stability, accuracy, robustness and safety through advanced event triggering mechanism and fault-tolerant control strategy, providing strong technical support for applications in industrial production and other fields. BRIEF DESCRIPTION OF THE DRAWINGS
[0060] In order to more clearly illustrate the technical solution of the present invention, the following briefly introduces the drawings required for use in the embodiments. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.
[0061] Figure 1 A schematic diagram of an event-triggered fault-tolerant control method for a robotic arm system provided in an embodiment of the present invention. DETAILED DESCRIPTION
[0062] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be clearly and completely described in conjunction with the specific embodiments of the present invention and the corresponding drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention. The technical solutions provided by the embodiments of the present invention are described in detail below in conjunction with the drawings.
[0063] In order to better understand the purpose of the present invention, the present invention is described in further detail below.
[0064] The present invention provides an event-triggered fault-tolerant control method for a robotic arm system, comprising:
[0065] Step S101, obtaining intelligent robot mechanical arm data and mechanical arm preset motion trajectory data, the intelligent robot mechanical arm data including mechanical arm motion data, sensor data, control system data, electrical system data and communication system data, performing fault detection on the intelligent robot mechanical arm data to obtain a fault detection result of the intelligent robot mechanical arm data;
[0066] In step S101, the process of obtaining the intelligent robot manipulator data and the preset motion trajectory data of the manipulator and performing fault detection on them is as follows:
[0067] Data acquisition: First, you need to obtain various data of the intelligent robot arm, including:
[0068] Robotic arm motion data: describes the motion state, position, speed and other information of the robotic arm.
[0069] Sensor data: comes from various sensors installed on the robotic arm, such as position sensors, force sensors, etc., which are used to sense the surrounding environment and the status of the robotic arm itself.
[0070] Control system data: control instructions, status feedback and other information generated by the control system.
[0071] Electrical system data: data related to the electrical part of the robot, such as motor current, voltage, etc.
[0072] Communication system data: data that the robot communicates with other systems or devices.
[0073] Preset motion trajectory data: At the same time, the system also needs to pre-load the preset motion trajectory data of the robot arm. These data include the predetermined path and motion parameters of the robot arm, which are the trajectories that the robot arm should follow when working normally.
[0074] Real-time monitoring: The system monitors the acquired intelligent robot arm data and the preset motion trajectory data of the robot arm in real time, paying special attention to whether there are sudden changes in the data or values outside the preset range.
[0075] Fault detection: When a mutation or a value outside a predetermined range is detected in the data, the system generates abnormal information of the intelligent robot arm, which is considered as part of fault detection.
[0076] Fault detection results: Through the above steps, the system obtains the fault detection results of the intelligent robot arm data, which will be used for subsequent fault handling and control strategy adjustment.
[0077] Step S101 is the basis of the entire fault-tolerant control method. The system can detect and respond to a fault in a timely manner before the fault occurs, providing a basis for subsequent fault-tolerant control.
[0078] Step S102, analyzing the fault detection result of the intelligent robot manipulator data to obtain manipulator arm fault data, matching the manipulator arm fault data in a preset fault adjustment rule library to obtain a manipulator arm control strategy corresponding to the fault, and executing the manipulator arm control strategy corresponding to the fault;
[0079] In step S102, the specific process of processing the fault detection result of the intelligent robot manipulator data is as follows:
[0080] Analyze fault detection results: First, analyze the fault detection results of the intelligent robot arm data, with the aim of extracting key arm fault data from the complex detection results.
[0081] Establish a fault adjustment rule base: The server needs to establish a fault adjustment rule base in advance, which contains the fault causes corresponding to various fault modes and the corresponding solution information.
[0082] Matching fault adjustment rules: Match the parsed robot arm fault data with the data in the fault adjustment rule library. The purpose of this step is to find a fault adjustment rule that matches the current fault situation.
[0083] Execute the robot arm control strategy corresponding to the fault: When the match is successful, the corresponding fault adjustment rule is extracted from the database as the fault adjustment rule matching result. The fault adjustment rule matching result includes the robot arm control strategy that should be adopted for the current fault situation, and then execute this control strategy to deal with the fault.
[0084] Fault adjustment feedback: After executing the fault adjustment rules, the robot system will provide fault adjustment feedback data, which is used to further analyze and optimize the control strategy, or as a reference for similar fault handling in the future.
[0085] Through step S102, it is possible to respond quickly after a robot arm fault is detected, find the most suitable control strategy through a preset fault adjustment rule library, and execute the strategy to restore the normal operation of the robot arm or reduce the impact of the fault.
[0086] Step S103, obtaining real-time intelligent robot mechanical arm data after executing the mechanical arm control strategy corresponding to the fault, comparing the real-time intelligent robot mechanical arm data with the preset mechanical arm motion trajectory data, obtaining real-time intelligent robot mechanical arm operation error data, retrieving intelligent robot mechanical arm historical data, real-time intelligent robot mechanical arm data and real-time intelligent robot mechanical arm operation error data and substituting them into a preset mechanical arm error analysis model, and obtaining a mechanical arm error analysis result;
[0087] Step S103 involves, after executing the control strategy for the robotic arm failure, comparing the real-time intelligent robot robotic arm data with the preset robotic arm motion trajectory data to obtain the robotic arm operation error, and substituting these error data and historical data into the preset robotic arm error analysis model for analysis to obtain the robotic arm error analysis result.
[0088] Get real-time data: Get real-time intelligent robot arm data after executing the arm control strategy corresponding to the fault.
[0089] Data comparison: These real-time intelligent robot arm data are compared with the preset robot arm motion trajectory data to identify the difference between the actual operation of the robot arm and the expected trajectory.
[0090] Error calculation: Calculate the operation error data of the real-time intelligent robot arm through comparison.
[0091] Error analysis model call: then retrieve the historical data of the intelligent robot arm, the real-time intelligent robot arm data and the real-time operation error data, and input these data into the preset robot arm error analysis model.
[0092] Error analysis results: The error analysis results of the robot arm are obtained by calculating the robot arm error analysis model. This result will provide a basis for subsequent control strategy adjustments.
[0093] The main purpose of step S103 is to timely identify the errors in the operation of the robot arm by comparing the real-time data with the preset trajectory, and to further quantify these errors using the error analysis model, so as to provide the necessary input for the subsequent dynamic adjustment and optimization of the robot arm control strategy through the fuzzy control algorithm. In this step, certain data processing techniques are required, such as data cleaning, outlier processing, etc., to ensure the data quality of the input error analysis model. The construction and training of the error analysis model is an important preparatory work before this step.
[0094] Step S104, based on the robot arm error analysis result, dynamically adjust the robot arm control strategy through the fuzzy control algorithm, generate the robot arm motion trajectory command, optimize the robot arm motion trajectory command, and the optimized robot arm motion trajectory command is used to adjust the motion trajectory of the robot arm;
[0095] In step S104, based on the robot error analysis results, the system uses a fuzzy control algorithm to dynamically adjust and optimize the robot control strategy and generate an optimized robot motion trajectory command. The following is a detailed explanation of this step:
[0096] Input error analysis results: The error analysis results of the robot arm obtained in step S103 are used as inputs of the fuzzy controller. These error analysis results reflect the difference between the actual running trajectory of the robot arm and the preset trajectory.
[0097] Fuzzy control algorithm: Use fuzzy control algorithm to perform fuzzy reasoning on the input error analysis results. Fuzzy control algorithm is a control strategy based on fuzzy set theory that can handle uncertainty and imprecise information.
[0098] Fuzzy reasoning: According to a preset set of fuzzy rules, the fuzzy controller converts the input error analysis results into the adjustment value of the output control quantity. These fuzzy rules are based on expert experience or actual operation data.
[0099] Dynamically adjust the robot arm control strategy: Use the output control adjustment value obtained by fuzzy reasoning to dynamically adjust the robot arm control strategy. Dynamic adjustment of the robot arm control strategy includes changing the parameters of the PID controller, the movement speed or acceleration of the robot arm, etc.
[0100] Generate optimized robot arm motion trajectory commands: Based on the adjusted robot arm control strategy, recalculate the preset motion trajectory data of the robot arm and generate optimized robot arm motion trajectory commands. These commands are used to guide the robot arm to move along the new trajectory.
[0101] Real-time monitoring and adjustment: Real-time monitoring of the motion data of the robot when it executes the adjusted robot motion trajectory command. These motion data are compared with the adjusted robot motion trajectory command to obtain new operation error data.
[0102] Further optimization: If the new operation error data still exceeds the preset robot arm motion trajectory error value, the system will use genetic algorithm to optimize the adjusted robot arm control strategy to obtain a better control strategy.
[0103] Determine genetic algorithm parameters: set population size, crossover rate, mutation rate, maximum number of iterations or fitness threshold, etc.
[0104] Encoding and decoding: Encode the parameters of the robot control strategy into the genes of the genetic algorithm, and decode them into actual control parameters after the optimization is completed.
[0105] Initialize population: Randomly generate a set of initial robot arm control strategies as the initial population.
[0106] Fitness evaluation: Use the fitness function to evaluate the performance of each individual, including the accuracy, stability, and response time of the motion trajectory.
[0107] Selection, crossover and mutation: select individuals according to their fitness values for crossover and mutation operations to generate a new population.
[0108] Iterative optimization: Repeat fitness evaluation, selection, crossover, and mutation operations until the termination condition is met.
[0109] Select the optimal solution: After reaching the termination condition, select the individual with the highest fitness as the optimal solution, and decode to obtain the optimized robotic arm control strategy.
[0110] Through step S104, the control strategy of the robotic arm can be adaptively adjusted and optimized, so that the robotic arm can still operate stably and complete the task in the presence of errors or faults.
[0111] Step S105, collect the robot arm operation data after the robot arm executes the optimized robot arm motion trajectory command, obtain the robot arm adjustment operation data, perform safety detection and analysis on the robot arm adjustment operation data, and obtain the robot arm adjustment operation safety detection result. If there is a safety risk in the robot arm adjustment operation safety detection result, execute the robot arm control strategy corresponding to the fault adjustment rule matching result.
[0112] In step S105, a series of operations of the robot system after executing the optimized robot motion trajectory command are described, including the following key points:
[0113] Collecting operation data: First, collect the actual operation data of the robot arm after executing the optimized robot arm motion trajectory command. This data is called the robot arm adjusted operation data.
[0114] Safety detection and analysis: Subsequently, the collected operating data of the robot arm after adjustment is subjected to safety detection and analysis. The purpose of this step is to evaluate whether the operating status of the robot arm is safe.
[0115] Obtain safety test results: After the safety test analysis, the safety test results of the robot arm after adjustment are obtained. The safety test results of the robot arm after adjustment will indicate whether there are safety risks in the operation of the robot arm.
[0116] Determine safety risks: The system then determines whether there are safety risks in the safety test results of the robot arm after adjustment. If there are safety risks, it means that the current robot arm operation state may be unstable or potentially dangerous.
[0117] Execute fault adjustment rules: If a safety risk is detected, the system will take countermeasures, that is, execute the robot control strategy corresponding to the fault adjustment rule matching result obtained by matching the fault detection result. This step is to adjust the control method of the robot to ensure that it operates in a safe and stable state.
[0118] Safety detection algorithm: Safety detection analysis is performed through a preset safety detection algorithm. The safety detection algorithm takes into account multiple factors, such as the range of motion of the robot arm, abnormal torque, speed fluctuation, etc., to comprehensively evaluate the operational safety of the robot arm.
[0119] Safety warning: If the safety detection result exceeds the preset safety range value, the system will generate a robot arm safety warning message to remind the operator to pay attention and take appropriate safety measures.
[0120] Step S105 together constitutes a safety monitoring and response mechanism of the robotic arm system after executing the optimized motion trajectory command, so that the robotic arm can operate stably in a complex environment.
[0121] Specifically, the event-triggered fault-tolerant control method for a robotic arm system provided by the present invention, step S101, comprises:
[0122] Pre-loading preset motion trajectory data of the robot arm, the preset motion trajectory data including a predetermined path and motion parameters;
[0123] Real-time monitoring of data mutations or values beyond a predetermined range in the intelligent robot's mechanical arm data and the mechanical arm's preset motion trajectory data;
[0124] When a data mutation or a value outside a predetermined range is detected, abnormal information of the intelligent robot arm is generated.
[0125] Specifically, the event-triggered fault-tolerant control method for the robotic arm system provided by the present invention, step S102 includes:
[0126] The server establishes a fault adjustment rule base, which includes fault causes and solution information corresponding to the fault mode;
[0127] The parsed fault data needs to be matched with the data in the fault adjustment rule library. After the match is successful, the corresponding fault adjustment rule is extracted from the database as the fault adjustment rule matching result;
[0128] The fault adjustment rule matching result includes adjusting the motion trajectory, speed, and acceleration of the robotic arm. The corresponding fault adjustment rule will be extracted from the database and sent to the robotic arm system to obtain the feedback data of the robotic arm's fault adjustment.
[0129] Specifically, the event-triggered fault-tolerant control method for the robotic arm system provided by the present invention, step S103, includes:
[0130] Copying the real-time intelligent robot manipulator data after executing the manipulator control strategy corresponding to the fault to obtain first data to be compared and second data to be compared;
[0131] Decomposing the preset motion trajectory data of the robot arm to obtain segmented data of the preset motion trajectory of the robot arm after the task decomposition, and generating time information corresponding to the segmented data according to the decomposed segmented data of the preset motion trajectory of the robot arm;
[0132] According to the time information corresponding to the segmented data, the preset motion trajectory of the robot arm is matched to obtain the time segmented motion trajectory of the robot arm.
[0133] Comparing the first data to be compared with the preset motion trajectory segment data of the robot arm to obtain a first error comparison result;
[0134] The second data to be compared is compared with the time segmented robot arm motion trajectory to obtain a second error comparison result.
[0135] Specifically, the event-triggered fault-tolerant control method for the robotic arm system provided by the present invention, step S103, includes:
[0136] Retrieving the preset robot arm movement trajectory in the preset robot arm movement trajectory segmented data after task decomposition, comparing the actual robot arm movement trajectory in the first to-be-compared data with the preset robot arm movement trajectory, and obtaining an error value between the actual robot arm movement trajectory in each segmented data and the expected movement trajectory after task decomposition;
[0137] Retrieving the preset robot arm movement trajectory in the time segment robot arm movement trajectory, comparing the actual movement trajectory of the robot arm in the second to-be-compared data with the time segment robot arm movement trajectory, and obtaining an error value between the time segment robot arm movement trajectory and the expected movement trajectory after task decomposition;
[0138] The error values between the actual motion trajectory of the robot arm in each segmented data and the expected motion trajectory after task decomposition, as well as the error values between the motion trajectory of the robot arm in the time segment and the expected motion trajectory after task decomposition, are summarized to obtain the real-time intelligent robot robot arm operation error data.
[0139] Specifically, the event-triggered fault-tolerant control method for the robotic arm system provided by the present invention, step S104 includes:
[0140] The error analysis result is used as the input of the fuzzy controller, and fuzzy reasoning is performed through the fuzzy control algorithm. According to the preset fuzzy rules, the adjustment value of the output control quantity is obtained, and the adjustment value of the control quantity is used to dynamically adjust the error analysis result of the robot arm. The dynamic adjustment of the error analysis result of the robot arm includes adjusting the parameters of the PID controller, changing the movement speed or acceleration of the robot arm, and obtaining the adjusted robot arm control strategy;
[0141] Based on the adjusted robot arm control strategy, the preset motion trajectory data of the robot arm is recalculated and an adjusted robot arm motion trajectory command is generated. The adjusted robot arm motion trajectory command includes the robot arm moving position, the robot arm moving speed, the robot arm moving acceleration, and the coordinated motion instructions of each joint of the robot arm;
[0142] Real-time monitoring of the motion data of the robot arm when it executes the adjusted robot arm motion trajectory command;
[0143] The motion data of the adjusted robot arm motion trajectory command is compared with the adjusted robot arm motion trajectory command to obtain the adjusted robot arm operation error data, and the adjusted robot arm operation error data is compared with the preset robot arm motion trajectory error value. If in the comparison result, the adjusted robot arm operation error data exceeds the preset robot arm motion trajectory error value, the adjusted robot arm control strategy is optimized using a genetic algorithm to obtain an optimized adjustment strategy.
[0144] Specifically, the event-triggered fault-tolerant control method for the robotic arm system provided by the present invention, step S104 includes:
[0145] Determine the population of the genetic algorithm and set the termination condition of the genetic algorithm, which includes the maximum number of iterations or the fitness threshold;
[0146] Encoding the parameters of the robot control strategy as genes of the genetic algorithm, the parameters of the robot control strategy including the parameters of the PID controller and the movement speed or acceleration of the robot;
[0147] Construct an initial population and randomly generate a set of initial robot arm control strategies;
[0148] For each robot control strategy in the population, a fitness function is used to quantify the performance of each robot control strategy to obtain the value of the fitness function, and each robot control strategy includes a combination of accuracy, stability, and response time indicators of the robot motion trajectory;
[0149] According to the value of the fitness function, individuals with better performance of the robot arm control strategy are selected to enter the next generation;
[0150] Randomly pair the selected robot arm control strategies and perform crossover operations to generate new robot arm control strategies;
[0151] Perform mutation operation on the newly generated robot arm control strategy to obtain a newly added robot arm control strategy population;
[0152] Add the newly added robot arm control strategy population to the next generation population;
[0153] After reaching the termination condition of the genetic algorithm, the robot control strategy with the highest fitness is selected as the optimal solution;
[0154] The optimal solution is decoded into the parameters of the robot control strategy to obtain the optimized adjustment strategy.
[0155] Specifically, in step S104 of the event-triggered fault-tolerant control method for the robotic arm system provided by the present invention, when the robotic arm control strategy needs to be optimized, a genetic algorithm is used. The detailed process of this step is as follows:
[0156] Determine the population of the genetic algorithm and set the termination condition: The genetic algorithm population represents a set of solutions, that is, different robot control strategies. The termination condition is usually set to the maximum number of iterations or fitness threshold to control when the algorithm stops.
[0157] Parameter encoding: Encoding the parameters of the robot control strategy (such as the parameters of the PID controller, the movement speed or acceleration of the robot) into the genes of the genetic algorithm. This encoding method enables the genetic algorithm to operate and optimize these parameters.
[0158] Constructing the initial population: Randomly generate a set of initial robot arm control strategies as the starting population of the genetic algorithm. The initial strategies represent different starting points in the search space.
[0159] Fitness evaluation: For each robot control strategy in the population, a fitness function is used to quantify its performance. The fitness function takes into account the accuracy, stability, response time and other indicators of the robot's motion trajectory to comprehensively evaluate the quality of the strategy.
[0160] Selection operation: According to the value of the fitness function, individuals with better performance are selected to enter the next generation population. This step aims to retain good genes and eliminate poor quality genes.
[0161] Crossover operation: randomly pair the selected robot control strategies and generate new control strategies through crossover operation. Crossover operation simulates the gene recombination process in biological evolution and helps to discover new excellent solutions.
[0162] Mutation operation: Perform mutation operation on the newly generated robot control strategy to increase the diversity of the population. Mutation operation simulates gene mutation, which helps to jump out of the local optimal solution and explore a wider search space.
[0163] Population update: Add the newly generated robot control strategy population to the next generation population. This process is iterated continuously until the termination condition of the genetic algorithm is reached.
[0164] Select the optimal solution: After reaching the termination condition of the genetic algorithm, the robot control strategy with the highest fitness is selected from the final population as the optimal solution. This optimal solution represents the best robot control strategy found in the current search space.
[0165] Decoding the optimal solution: Decode the optimal solution into specific parameters of the robot control strategy to obtain the optimized adjustment strategy. These optimized parameters will be used to adjust the motion trajectory of the robot to improve its performance and stability.
[0166] Through the above steps, the method of the present invention can utilize genetic algorithms to dynamically optimize the control strategy of the robot arm to cope with complex control problems and improve the operational stability and accuracy of the robot arm under fault conditions.
[0167] Specifically, the event-triggered fault-tolerant control method for the robotic arm system provided by the present invention, step S105, comprises:
[0168] Use the preset safety detection algorithm to analyze the operation data of the robot arm after adjustment to obtain the robot arm's motion range detection results, robot arm abnormal torque detection results, and robot arm speed fluctuation detection results;
[0169] If the robot arm's motion range detection result, the robot arm's abnormal torque detection result, and the robot arm's speed fluctuation detection result are within the preset safety range value, the robot arm's operating status continues to be monitored;
[0170] If the robot arm's motion range detection result, the robot arm's abnormal torque detection result, and the robot arm's speed fluctuation detection result are not within the preset safety range value, a robot arm safety warning information is generated.
[0171] The technical solution of the present invention solves the problem that the running state of the mechanical arm of the intelligent robot differs from the preset trajectory in the event of a fault, resulting in unstable operation and reduced control accuracy through the following steps:
[0172] Real-time monitoring and fault detection: Real-time monitoring of various data of the intelligent robot arm, and generating abnormal information for fault detection when data mutations or exceeding the predetermined range are detected.
[0173] Fault analysis and strategy matching: Analyze the fault data, find and execute the corresponding solution strategy in the preset fault adjustment rule library.
[0174] Operation error analysis and dynamic adjustment: Obtain operation error data by comparing real-time robot arm data with preset motion trajectory, perform error analysis, and dynamically adjust the control strategy through fuzzy control algorithm.
[0175] Safety detection and feedback: Safety detection and analysis are performed on the robot operation data that executes the optimized trajectory command, and corresponding control strategies are executed when safety risks are found to ensure stable operation.
[0176] Intelligent optimization: If the operating error exceeds the preset range, the control strategy is further optimized using a genetic algorithm.
[0177] The technical solution of the present invention constitutes a closed-loop control system, which is designed to detect faults in a timely manner, dynamically adjust control strategies, and ensure stable operation of the robot arm through intelligent optimization.
[0178] Obviously, those skilled in the art can make various changes and modifications to the present invention without departing from the spirit and scope of the present invention. Thus, if these modifications and variations of the present invention fall within the scope of the claims of the present invention and their equivalents, the present invention is also intended to include these modifications and variations, and the above-described embodiments of the present invention do not constitute a limitation on the scope of protection of the present invention.
Claims
1. An event-triggered fault-tolerant control method for a robotic arm system, characterized in that: include: Step S101, obtaining intelligent robot mechanical arm data and mechanical arm preset motion trajectory data, the intelligent robot mechanical arm data including mechanical arm motion data, sensor data, control system data, electrical system data and communication system data, performing fault detection on the intelligent robot mechanical arm data to obtain a fault detection result of the intelligent robot mechanical arm data; Step S102, analyzing the fault detection result of the intelligent robot manipulator data to obtain manipulator arm fault data, matching the manipulator arm fault data in a preset fault adjustment rule library to obtain a manipulator arm control strategy corresponding to the fault, and executing the manipulator arm control strategy corresponding to the fault; Step S103, obtaining real-time intelligent robot mechanical arm data after executing the mechanical arm control strategy corresponding to the fault, comparing the real-time intelligent robot mechanical arm data with the preset mechanical arm motion trajectory data, obtaining real-time intelligent robot mechanical arm operation error data, retrieving intelligent robot mechanical arm historical data, real-time intelligent robot mechanical arm data and real-time intelligent robot mechanical arm operation error data and substituting them into a preset mechanical arm error analysis model, and obtaining a mechanical arm error analysis result; In step S103, the real-time intelligent robot mechanical arm data is compared with the preset motion trajectory data of the mechanical arm to obtain the real-time intelligent robot mechanical arm operation error data, including: Copying the real-time intelligent robot manipulator data after executing the manipulator control strategy corresponding to the fault to obtain first data to be compared and second data to be compared; Decomposing the preset motion trajectory data of the robot arm to obtain segmented data of the preset motion trajectory of the robot arm after the task decomposition, and generating time information corresponding to the segmented data according to the decomposed segmented data of the preset motion trajectory of the robot arm; According to the time information corresponding to the segmented data, the preset motion trajectory of the robot arm is matched to obtain the time segmented motion trajectory of the robot arm. Comparing the first data to be compared with the preset motion trajectory segment data of the robot arm to obtain a first error comparison result; Comparing the second data to be compared with the time segmented robot arm motion trajectory to obtain a second error comparison result; Retrieving the preset robot arm movement trajectory in the preset robot arm movement trajectory segmented data after task decomposition, comparing the actual robot arm movement trajectory in the first to-be-compared data with the preset robot arm movement trajectory, and obtaining an error value between the actual robot arm movement trajectory in each segmented data and the expected movement trajectory after task decomposition; Retrieving the preset robot arm movement trajectory in the time segment robot arm movement trajectory, comparing the actual movement trajectory of the robot arm in the second to-be-compared data with the time segment robot arm movement trajectory, and obtaining an error value between the time segment robot arm movement trajectory and the expected movement trajectory after task decomposition; The error values between the actual motion trajectory of the robot arm in each segmented data and the expected motion trajectory after task decomposition, as well as the error values between the motion trajectory of the robot arm in the time segment and the expected motion trajectory after task decomposition, are summarized to obtain the real-time intelligent robot robot arm operation error data; Step S104, based on the robot arm error analysis result, dynamically adjust the robot arm control strategy through the fuzzy control algorithm, generate the robot arm motion trajectory command, optimize the robot arm motion trajectory command, and the optimized robot arm motion trajectory command is used to adjust the motion trajectory of the robot arm; Step S105, collect the robot arm operation data after the robot arm executes the optimized robot arm motion trajectory command, obtain the robot arm adjustment operation data, perform safety detection and analysis on the robot arm adjustment operation data, and obtain the robot arm adjustment operation safety detection result. If there is a safety risk in the robot arm adjustment operation safety detection result, execute the robot arm control strategy corresponding to the fault adjustment rule matching result.
2. The event-triggered fault-tolerant control method of a robotic arm system according to claim 1, characterized in that: The step S101 includes: Pre-loading preset motion trajectory data of the robot arm, the preset motion trajectory data including a predetermined path and motion parameters; Real-time monitoring of data mutations or values beyond a predetermined range in the intelligent robot's mechanical arm data and the mechanical arm's preset motion trajectory data; When a data mutation or a value outside a predetermined range is detected, abnormal information of the intelligent robot arm is generated.
3. The event-triggered fault-tolerant control method of a robotic arm system according to claim 1, characterized in that: The step S102 includes: The server establishes a fault adjustment rule base, which includes fault causes and solution information corresponding to the fault mode; The parsed fault data needs to be matched with the data in the fault adjustment rule library. After the match is successful, the corresponding fault adjustment rule is extracted from the database as the fault adjustment rule matching result; The fault adjustment rule matching result includes adjusting the motion trajectory, speed and acceleration of the robot arm. The corresponding fault adjustment rule will be extracted from the database and sent to the robot arm system to obtain the fault adjustment feedback data of the robot arm.
4. The event-triggered fault-tolerant control method of a robotic arm system according to claim 1, characterized in that: The step S104 includes: The error analysis result is used as the input of the fuzzy controller, and fuzzy reasoning is performed through the fuzzy control algorithm. According to the preset fuzzy rules, the adjustment value of the output control quantity is obtained, and the adjustment value of the control quantity is used to dynamically adjust the error analysis result of the robot arm. The dynamic adjustment of the error analysis result of the robot arm includes adjusting the parameters of the PID controller, changing the movement speed or acceleration of the robot arm, and obtaining the adjusted robot arm control strategy; Based on the adjusted robot arm control strategy, the preset motion trajectory data of the robot arm is recalculated and an adjusted robot arm motion trajectory command is generated. The adjusted robot arm motion trajectory command includes the robot arm moving position, the robot arm moving speed, the robot arm moving acceleration, and the coordinated motion instructions of each joint of the robot arm; Real-time monitoring of the motion data of the robot arm when it executes the adjusted robot arm motion trajectory command; The motion data of the adjusted robot arm motion trajectory command is compared with the adjusted robot arm motion trajectory command to obtain the adjusted robot arm operation error data, and the adjusted robot arm operation error data is compared with the preset robot arm motion trajectory error value. If in the comparison result, the adjusted robot arm operation error data exceeds the preset robot arm motion trajectory error value, the adjusted robot arm control strategy is optimized using a genetic algorithm to obtain an optimized adjustment strategy.
5. The event-triggered fault-tolerant control method of a robotic arm system according to claim 1, characterized in that: The step S104 includes: Determine the population of the genetic algorithm and set the termination condition of the genetic algorithm, which includes the maximum number of iterations or the fitness threshold; Encoding the parameters of the robot control strategy as genes of the genetic algorithm, the parameters of the robot control strategy including the parameters of the PID controller and the movement speed or acceleration of the robot; Construct an initial population and randomly generate a set of initial robot arm control strategies; For each robot control strategy in the population, a fitness function is used to quantify the performance of each robot control strategy to obtain the value of the fitness function, and each robot control strategy includes a combination of accuracy, stability, and response time indicators of the robot motion trajectory; According to the value of the fitness function, individuals with better performance of the robot arm control strategy are selected to enter the next generation; Randomly pair the selected robot arm control strategies and perform crossover operations to generate new robot arm control strategies; Perform mutation operation on the newly generated robot arm control strategy to obtain a newly added robot arm control strategy population; Add the newly added robot arm control strategy population to the next generation population; After reaching the termination condition of the genetic algorithm, the robot control strategy with the highest fitness is selected as the optimal solution; The optimal solution is decoded into the parameters of the robot control strategy to obtain the optimized adjustment strategy.
6. The event-triggered fault-tolerant control method of a robotic arm system according to claim 1, characterized in that: The step S105 includes: Use the preset safety detection algorithm to analyze the operation data of the robot arm after adjustment to obtain the robot arm's motion range detection results, robot arm abnormal torque detection results, and robot arm speed fluctuation detection results; If the robot arm's motion range detection result, the robot arm's abnormal torque detection result, and the robot arm's speed fluctuation detection result are within the preset safety range value, the robot arm's operating status continues to be monitored; If the robot arm's motion range detection result, the robot arm's abnormal torque detection result, and the robot arm's speed fluctuation detection result are not within the preset safety range value, a robot arm safety warning information is generated.
Citation Information
Patent Citations
Trajectory tracking control method based on parameter optimization and used for reconfigurable modularized flexible mechanical arm
CN109551479A
Mechanical arm active fault-tolerant control method based on deep reinforcement learning
CN113954069A
