Control method, system and platform of industrial robot based on hybrid sparrow algorithm
The hybrid sparrow algorithm quickly determines the best PID parameters, which solves the problem of long identification time and low accuracy of PID self-tuning control in the existing technology, improves the control accuracy and stability of industrial robots, and ensures safety in complex environments run.
Patent Information
- Application Number
- CN202411080540.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-08
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2044-08-08
AI Technical Summary
Existing intelligent mathematical models or algorithms have problems with long identification time and low identification accuracy in PID self-tuning control. Due to strong coupling and insufficient control accuracy, industrial robots are difficult to reach a stable state in a short time.
The hybrid sparrow algorithm is used to quickly determine the best PID parameters, and the global search is carried out through the genetic algorithm and the sparrow search algorithm for local search, optimize the controller parameters of the servo motor, reduce manual adjustment time, and improve control accuracy and stability.
It effectively improves the control performance and control accuracy of industrial robots, suppresses jitter during movement, improves the stability of the servo motor, and ensures the working stability and safety in complex environments.
Smart Images

Figure CN118596160B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of intelligent robots, and in particular to a control method, system and platform for an industrial robot based on a hybrid sparrow algorithm. Background Art
[0002] The control of servo motor PID parameters is very important for the operation accuracy and stability of industrial robots. With the deepening of research, more and more intelligent mathematical models or algorithms such as BP neural network model, particle swarm algorithm, genetic algorithm, etc. are introduced into the classic PID control to obtain a more intelligent PID controller.
[0003] However, the PID self-tuning control method based on intelligent mathematical models or algorithms has the disadvantages of long identification time and low identification accuracy, which greatly limits the actual use of the PID self-tuning control method based on intelligent mathematical models or algorithms. On the other hand, since industrial robots have strong coupling, changes in friction between joints and changes in end loads will cause considerable disturbances to the control system of industrial robots, resulting in insufficient control accuracy, so that the servo motor system of the industrial robot cannot reach a stable state in a very short time. Therefore, it is urgent to develop a control method for industrial robots to improve control accuracy. Summary of the invention
[0004] The present invention aims to provide a control method, system and platform for an industrial robot based on a hybrid sparrow algorithm, which can quickly determine the optimal PID parameters through the hybrid sparrow algorithm, reduce the time for manual adjustment of PID parameters, improve the control performance and control accuracy of the industrial robot, and at the same time have a good inhibitory effect on the jitter generated by the industrial robot during movement, effectively improve the stability of the servo motor, and ensure the stability and safety of the industrial robot working in a complex environment.
[0005] The technical solution adopted by the present invention is:
[0006] A control method for an industrial robot based on a hybrid sparrow algorithm comprises the following steps:
[0007] Step S1, setting the action mode A of the industrial robot based on the current position and working requirements of the industrial robot;
[0008] Step S2, disassembling the action mode A according to the action steps to obtain a plurality of continuous decomposed actions; analyzing the rotation angle of the shaft of the servo motor driving the corresponding joint movement on the industrial robot from the previous decomposed action to the next decomposed action, and converting the rotation angle into the number of rotations; the current decomposed action, all the servo motors corresponding to the current decomposed action, and the rotation angle and the number of rotations corresponding to each servo motor constitute the motion data corresponding to the current decomposed action; and collecting the motion data corresponding to all the decomposed actions to form a motion data set corresponding to the action mode A;
[0009] Step S3, importing the motion data in the motion data set into the constructed hybrid sparrow algorithm mathematical model one by one for calculation and analysis, and obtaining the optimal PID parameters of the controller corresponding to the servo motor driving the corresponding joint movement on the industrial robot from the previous decomposition action to the next decomposition action; and collecting the optimal PID parameters corresponding to all the decomposition actions to form an optimal PID parameter set corresponding to the action mode A;
[0010] Step S4: Based on the optimal PID parameter set, the controller controls the corresponding servo motor to operate, thereby realizing motion control of the industrial robot in the motion mode A.
[0011] Furthermore, it also includes:
[0012] Step S5, when the industrial robot switches from the motion mode A to the motion mode B based on the adjustment of the current position and / or the working requirements, refer to steps S2 to S4 and execute again.
[0013] Furthermore, in step S3, the specific process of obtaining the optimal PID parameters by the hybrid sparrow algorithm mathematical model operation and analysis is as follows: first, a set of PID initial parameters are preset, and then a genetic algorithm is used to perform a global search based on the PID initial parameters to determine the reference range of the optimal PID parameters, and finally a sparrow search algorithm is used to perform a local search within the reference range to find the optimal PID parameters.
[0014] Furthermore, the specific process by which the controller in step S4 controls the corresponding servo motor based on the optimal PID parameter set includes: collecting the three-phase current of the servo motor that drives the corresponding joint movement on the industrial robot, then using a field-oriented control algorithm and introducing the corresponding optimal PID parameters to calculate the three-phase current to obtain an optimal control current, and finally the controller drives the corresponding servo motor to work with the optimal control current.
[0015] Based on the same inventive concept, the present invention also provides a control system for an industrial robot based on a hybrid sparrow algorithm to implement the aforementioned control method for an industrial robot based on a hybrid sparrow algorithm, comprising:
[0016] A setting module, the setting module is used to set the action mode A of the industrial robot based on the current position and working requirements of the industrial robot;
[0017] A disassembly and analysis module, wherein the disassembly and analysis module is used to disassemble the action mode A according to the action steps to obtain a plurality of continuous decomposed actions; analyze the rotation angle of the shaft of the servo motor driving the corresponding joint movement on the industrial robot from the previous decomposed action to the next decomposed action, and convert the rotation angle into the number of rotations; the current decomposed action, all the servo motors corresponding to the current decomposed action, and the rotation angle and the number of rotations corresponding to each servo motor constitute the motion data corresponding to the current decomposed action; and the motion data corresponding to all the decomposed actions are collected to form a motion data set corresponding to the action mode A;
[0018] An operation and analysis module, wherein the operation and analysis module imports the motion data in the motion data set into the constructed hybrid sparrow algorithm mathematical model one by one for operation and analysis, and obtains the optimal PID parameters of the controller corresponding to the servo motor driving the corresponding joint movement on the industrial robot from the previous decomposition action to the next decomposition action; and collects the optimal PID parameters corresponding to all the decomposition actions to form an optimal PID parameter set corresponding to the action mode A;
[0019] An execution control module is used to control the corresponding servo motor to work based on the optimal PID parameter set by the controller, so as to realize the motion control of the industrial robot in the motion mode A.
[0020] Furthermore, it also includes:
[0021] A reset module, wherein the reset module is used to reset the disassembly analysis module, the operation analysis module and the execution control module when the industrial robot switches from the action mode A to the action mode B based on the adjustment of the current position and / or work requirements, and then re-implement the control in the action mode B with reference to the control method of the industrial robot in the action mode A.
[0022] Based on the same inventive concept, the present invention also provides a control platform for an industrial robot based on a hybrid sparrow algorithm, comprising a communication module, an ARM processor, an FPGA processor, an FMC bus and a storage module; wherein the ARM processor and the FPGA processor are connected via the FMC bus, and the communication module and the storage module are connected to the ARM processor; the ARM processor and the FPGA processor execute the aforementioned control method for the industrial robot based on the hybrid sparrow algorithm by running a preset program.
[0023] Furthermore, the communication module is a serial communication module, an RS485 communication module or an Ethernet communication module.
[0024] Furthermore, the storage module is an SDRAM memory, an EEPROM memory or a FLASH memory.
[0025] The beneficial effects of the present invention are:
[0026] The present invention provides a control method, system and platform for an industrial robot based on a hybrid sparrow algorithm. The hybrid sparrow algorithm is used to quickly determine the optimal PID parameters, reduce the time for manual adjustment of PID parameters, improve the control performance and control accuracy of the industrial robot, and at the same time has a good inhibitory effect on the jitter generated by the industrial robot during movement, effectively improving the stability of the servo motor, and ensuring the stability and safety of the industrial robot working in a complex environment. BRIEF DESCRIPTION OF THE DRAWINGS
[0027] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0028] Figure 1 This is a flow chart of the control method of the industrial robot in Example 1.
[0029] Figure 2For the same working mode A in this embodiment, the classic PID controller, sparrow search algorithm SSA-PID controller, genetic algorithm GA-PID controller and hybrid sparrow algorithm HSSA-PID controller in this embodiment are simulated and controlled by Vivado simulation software, and then the unit step response convergence curve is generated by Matlab software with time time as the horizontal coordinate and the controller output signal PIDcontrol output as the vertical coordinate. Among them, the red dotted line represents the input command signal rin, the blue solid line represents the sparrow search algorithm SSA-PID controller, the green solid line represents the hybrid sparrow algorithm HSSA-PID controller in this embodiment, the purple solid line represents the classic PID controller, and the black solid line represents the genetic algorithm GA-PID controller.
[0030] Figure 3 for Figure 2 Unit step response convergence curve after local amplification in the figure. DETAILED DESCRIPTION
[0031] In the description of the present invention, it should be understood that the terms "center", "longitudinal", "lateral", "length", "width", "thickness", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside", "clockwise", "counterclockwise", "axial", "radial", "circumferential" and the like indicate orientations or positional relationships based on the orientations or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the referred device or element must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be understood as limiting the present invention.
[0032] The disclosure below provides many different embodiments or examples to realize different structures of the present invention. In order to simplify the disclosure of the present invention, the parts and settings of specific examples are described below. Of course, they are only examples, and the purpose is not to limit the present invention.
[0033] The embodiments of the invention are described in detail below with reference to the accompanying drawings.
[0034] Embodiment 1, a control method of an industrial robot based on a hybrid sparrow algorithm, the process of which is as shown in the attached Figure 1 The control method of the industrial robot comprises the following steps:
[0035] Step S1, setting the action mode A of the industrial robot based on the current position and working requirements of the industrial robot. For example, if the "raw materials" in production line 1 need to be put into production line 2 for processing, the industrial robot must be set to perform a series of actions of "grasping - rising - transferring - descending - putting down" according to the actual scenario.
[0036] Step S2, disassemble the action mode A according to the action steps to obtain a plurality of continuous decomposed actions; analyze the rotation angle of the shaft of the servo motor on the industrial robot that drives the corresponding joint movement from the previous decomposed action to the next decomposed action, and convert the rotation angle into the number of rotations; the current decomposed action, all the servo motors corresponding to the current decomposed action, and the rotation angle and the number of rotations corresponding to each servo motor constitute the motion data corresponding to the current decomposed action; and gather the motion data corresponding to all the decomposed actions to form a motion data set corresponding to the action mode A.
[0037] Step S3, importing the motion data in the motion data set one by one into the constructed hybrid sparrow algorithm mathematical model for calculation and analysis, and obtaining the optimal PID parameters of the controller corresponding to the servo motor that drives the corresponding joint movement on the industrial robot from the previous decomposition action to the next decomposition action; and collecting the optimal PID parameters corresponding to all the decomposition actions to form an optimal PID parameter set corresponding to the action mode A.
[0038] Step S4: Based on the optimal PID parameter set, the controller controls the corresponding servo motor to operate, thereby realizing motion control of the industrial robot in the motion mode A.
[0039] Step S5, when the industrial robot switches from the action mode A to the action mode B based on the adjustment of the current position and / or the working requirements, refer to the steps S2 to S4 and re-execute. Since the same optimal PID parameters may not meet the current situation well after the current position and / or the working requirements are adjusted, refer to the steps S2 to S4 and re-execute and use the new optimal PID parameters to control the industrial robot.
[0040] In this embodiment, for the same working mode A, the classic PID controller, the sparrow search algorithm SSA-PID controller, the genetic algorithm GA-PID controller and the hybrid sparrow algorithm HSSA-PID controller in this embodiment are simulated and controlled by Vivado simulation software, and then the unit step response convergence curve is generated by Matlab software with time time as the horizontal axis (unit ms) and the controller output signal PIDcontrol output as the vertical axis, as shown in the attached figure. Figure 2 and attached Figure 3As shown in . Among them, the red dotted line represents the input command signal rin, the blue solid line represents the sparrow search algorithm SSA-PID controller, the green solid line represents the hybrid sparrow algorithm HSSA-PID controller in this embodiment, the purple solid line represents the classic PID controller, and the black solid line represents the genetic algorithm GA-PID controller. It can be seen from the figure that after adopting the hybrid sparrow algorithm HSSA-PID controller in this embodiment, the system takes a shorter time to reach a stable state from the initial state and there is no overshoot, which can better meet the control requirements.
[0041] In this embodiment, the hybrid sparrow algorithm is used to quickly determine the optimal PID parameters, reduce the time for manual adjustment of PID parameters, improve the control performance and control accuracy of the industrial robot, and at the same time, has a good inhibitory effect on the jitter generated by the industrial robot during movement, effectively improving the stability of the servo motor, and ensuring the stability and safety of the industrial robot working in a complex environment.
[0042] In this embodiment, the specific process of obtaining the optimal PID parameters by the hybrid sparrow algorithm mathematical model operation analysis in step S3 is: first preset a set of PID initial parameters, then use the genetic algorithm to perform a global search based on the PID initial parameters to determine the reference range of the optimal PID parameters, and finally use the sparrow search algorithm SSA to perform a local search in the reference range to find the optimal PID parameters. In this embodiment, the chromosome individuals of the genetic algorithm GA are used to conduct in-depth search and optimization of the solution through operations such as selection, crossover and mutation, which can quickly discover potential solution space, has strong global optimization ability, and has high efficiency for large-scale search. Then, the bird flock individuals of the sparrow search algorithm SSA are used to adjust their positions according to local and global information to cover as wide a search space as possible, so that it can find the optimal solution more quickly, suppress the jitter of the industrial robot at work, and improve the stability of the servo motor.
[0043] In this embodiment, the specific process of the controller in step S4 controlling the corresponding servo motor based on the optimal PID parameter set includes: collecting the three-phase current of the servo motor driving the corresponding joint movement on the industrial robot, then using the field-oriented control algorithm FOC and bringing in the corresponding optimal PID parameters to calculate the three-phase current to obtain the optimal control current, and finally the controller drives the corresponding servo motor to work with the optimal control current. More specifically, the U, V, and W three-phase currents of the servo motor are first collected, and the current sinusoidal curve is converted into a linear model that is convenient for PID control through Clark and Park transformation, and then the optimal PID parameters are converted into PWM waveform output, and finally converted into new U, V, and W three-phase currents to control the servo motor.
[0044] Embodiment 2, a control system of an industrial robot based on a sparrow algorithm, to implement the control method of an industrial robot based on a hybrid sparrow algorithm in embodiment 1. The control system of the industrial robot includes: a setting module, a disassembly analysis module, an operation analysis module, an execution control module and a reset module.
[0045] Specifically, the setting module is used to set the action mode A of the industrial robot based on the current position and working requirements of the industrial robot. The disassembly analysis module is used to disassemble the action mode A according to the action steps to obtain a number of continuous decomposed actions; analyze the rotation angle of the shaft of the servo motor that drives the corresponding joint movement on the industrial robot from the previous decomposed action to the next decomposed action, and convert the rotation angle into the number of rotations; the current decomposed action, all the servo motors corresponding to the current decomposed action, and the rotation angle and the number of rotations corresponding to each servo motor constitute the motion data corresponding to the current decomposed action; the motion data corresponding to all the decomposed actions are collected to form the motion data set corresponding to the action mode A. The operation analysis module imports the motion data in the motion data set into the constructed hybrid sparrow algorithm mathematical model one by one for operation analysis, and obtains the optimal PID parameters of the controller corresponding to the servo motor that drives the corresponding joint movement on the industrial robot from the previous decomposed action to the next decomposed action; the optimal PID parameters corresponding to all the decomposed actions are collected to form the optimal PID parameter set corresponding to the action mode A. The execution control module is used to control the corresponding servo motor to work by the controller based on the optimal PID parameter set, so as to realize the motion control of the industrial robot in the motion mode A. The reset module is used to reset the disassembly analysis module, the operation analysis module and the execution control module when the industrial robot switches from the motion mode A to the motion mode B based on the adjustment of the current position and / or work requirements, and then re-implement the control in the motion mode B with reference to the control method of the industrial robot in the motion mode A.
[0046] In this embodiment, the hybrid sparrow algorithm is used to quickly determine the optimal PID parameters, reduce the time for manual adjustment of PID parameters, improve the control performance and control accuracy of the industrial robot, and at the same time, has a good inhibitory effect on the jitter generated by the industrial robot during movement, effectively improving the stability of the servo motor, and ensuring the stability and safety of the industrial robot working in a complex environment.
[0047] Embodiment 3, a control platform for an industrial robot based on a hybrid sparrow algorithm, comprising a communication module, an ARM processor, an FPGA processor, an FMC bus and a storage module; wherein the ARM processor and the FPGA processor are connected via the FMC bus, and the communication module and the storage module are connected to the ARM processor. The ARM processor is mainly responsible for processing system task scheduling, kinematic algorithms, data transmission and communication with a host computer. The FPGA processor is mainly responsible for the SVPWM output, current detection, encoder data feedback, communication interface, PID optimization algorithm, etc. of the six axes of the industrial robot. The ARM processor and the FPGA processor execute the control method of the industrial robot based on the hybrid sparrow algorithm in Embodiment 1 by running a preset program.
[0048] Furthermore, the communication module is a serial communication module, an RS485 communication module or an Ethernet communication module. The storage module is an SDRAM memory, an EEPROM memory or a FLASH memory.
[0049] In this embodiment, the hybrid sparrow algorithm is used to quickly determine the optimal PID parameters, reduce the time for manual adjustment of PID parameters, improve the control performance and control accuracy of the industrial robot, and at the same time, has a good inhibitory effect on the jitter generated by the industrial robot during movement, effectively improving the stability of the servo motor, and ensuring the stability and safety of the industrial robot working in a complex environment.
Claims
1. A control method for an industrial robot based on a hybrid sparrow algorithm, characterized in that: The following steps are involved: Step S1, setting the action mode A of the industrial robot based on the current position and working requirements of the industrial robot; Step S2, disassembling the action mode A according to the action steps to obtain a plurality of continuous decomposed actions; analyzing the rotation angle of the shaft of the servo motor driving the corresponding joint movement on the industrial robot from the previous decomposed action to the next decomposed action, and converting the rotation angle into the number of rotations; the current decomposed action, all the servo motors corresponding to the current decomposed action, and the rotation angle and the number of rotations corresponding to each servo motor constitute the motion data corresponding to the current decomposed action; and collecting the motion data corresponding to all the decomposed actions to form a motion data set corresponding to the action mode A; Step S3, importing the motion data in the motion data set into the constructed hybrid sparrow algorithm mathematical model one by one for calculation and analysis, and obtaining the optimal PID parameters of the controller corresponding to the servo motor driving the corresponding joint movement on the industrial robot from the previous decomposition action to the next decomposition action; and collecting the optimal PID parameters corresponding to all the decomposition actions to form an optimal PID parameter set corresponding to the action mode A; Step S4, based on the optimal PID parameter set, the controller controls the corresponding servo motor to operate, so as to realize motion control of the industrial robot in the motion mode A; The specific process of obtaining the optimal PID parameters by the hybrid sparrow algorithm mathematical model operation analysis in step S3 is as follows: firstly, a set of PID initial parameters are preset, and then a genetic algorithm is used to perform a global search based on the PID initial parameters to determine the reference range of the optimal PID parameters, and finally a sparrow search algorithm is used to perform a local search within the reference range to find the optimal PID parameters; The specific process of the controller in step S4 controlling the corresponding servo motor based on the optimal PID parameter set includes: collecting the three-phase current of the servo motor that drives the corresponding joint movement on the industrial robot, then using a field-oriented control algorithm and introducing the corresponding optimal PID parameters to calculate the three-phase current to obtain the optimal control current, and finally the controller drives the corresponding servo motor to work with the optimal control current.
2. The control method of an industrial robot based on a hybrid sparrow algorithm according to claim 1, characterized in that: Also includes: Step S5, when the industrial robot switches from the motion mode A to the motion mode B based on the adjustment of the current position and / or the working requirements, refer to steps S2 to S4 and execute again.
3. A control system for an industrial robot based on a hybrid sparrow algorithm, to implement the control method for an industrial robot based on a hybrid sparrow algorithm as claimed in claim 1 or 2, characterized in that: include: A setting module, the setting module is used to set the action mode A of the industrial robot based on the current position and working requirements of the industrial robot; A disassembly and analysis module, wherein the disassembly and analysis module is used to disassemble the action mode A according to the action steps to obtain a plurality of continuous decomposed actions; analyze the rotation angle of the shaft of the servo motor driving the corresponding joint movement on the industrial robot from the previous decomposed action to the next decomposed action, and convert the rotation angle into the number of rotations; the current decomposed action, all the servo motors corresponding to the current decomposed action, and the rotation angle and the number of rotations corresponding to each servo motor constitute the motion data corresponding to the current decomposed action; and the motion data corresponding to all the decomposed actions are collected to form a motion data set corresponding to the action mode A; An operation and analysis module, wherein the operation and analysis module imports the motion data in the motion data set into the constructed hybrid sparrow algorithm mathematical model one by one for operation and analysis, and obtains the optimal PID parameters of the controller corresponding to the servo motor driving the corresponding joint movement on the industrial robot from the previous decomposition action to the next decomposition action; and collects the optimal PID parameters corresponding to all the decomposition actions to form an optimal PID parameter set corresponding to the action mode A; An execution control module is used to control the corresponding servo motor to work based on the optimal PID parameter set by the controller, so as to realize the motion control of the industrial robot in the motion mode A.
4. The control system of an industrial robot based on a hybrid sparrow algorithm according to claim 3 is characterized in that: Also includes: A reset module, wherein the reset module is used to reset the disassembly analysis module, the operation analysis module and the execution control module when the industrial robot switches from the action mode A to the action mode B based on the adjustment of the current position and / or work requirements, and then re-implement the control in the action mode B with reference to the control method of the industrial robot in the action mode A.
5. A control platform for an industrial robot based on a hybrid sparrow algorithm, characterized in that: It includes a communication module, an ARM processor, an FPGA processor, an FMC bus and a storage module; wherein the ARM processor and the FPGA processor are connected via the FMC bus, and the communication module and the storage module are connected to the ARM processor; the ARM processor and the FPGA processor execute the control method of the industrial robot based on the hybrid sparrow algorithm as claimed in claim 1 or 2 by running a preset program.
6. The control platform of the industrial robot based on the hybrid sparrow algorithm according to claim 5, characterized in that: The communication module is a serial communication module, an RS485 communication module or an Ethernet communication module.
7. The control platform of the industrial robot based on the hybrid sparrow algorithm according to claim 5, characterized in that: The storage module is an SDRAM memory, an EEPROM memory or a FLASH memory.
Citation Information
Patent Citations
Improved sparrow search algorithm optimized three-phase SAPF DC side control method
CN113363963A
Parameter setting method of linear active disturbance rejection controller based on sparrow search algorithm
CN115032897A
Extra-high voltage direct current transmission line fault identification method based on multi-decomposition and parallel residual network
CN115825648A
PID transfer platform single-degree-of-freedom leveling control system and method based on improved SSA algorithm optimization
CN118068690A
Method for constructing decoupling controller of permanent magnet auxiliary bearingless synchronous reluctance motor
CN118117925A
